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ABSTRACT 


Problems related to the guidance of an autonomous rover 
for unmanned planetary exploration have been investigated. 
Included in these studies were: simulation on an interactive 

graphics computer system of the Rapid Estimation Technique for 
detection of discrete obstacles; incorporation of a simultaneous 
Bayesian estimate of states and inputs in the Rapid Estimation 
Scheme; development of methods for estimating actual laser 
rangefinder errors and their application to date provided by 
Jet Propulsion Laboratory; and modification of a path selection 
system simulation computer code for evaluation of a hazard 
detection system based on laser rangefinder data. 



INTRODUCTION 


A thorough exploration of planets or other extraterrestrial bodies 
by unmanned data acquisition systems must deal with formidable control 
problems posed by the long (9 to 45 minutes for Mars and more in other 
cases) round-trip communications delay. Time delays of these orders of 
magnitude preclude all but the most rudimentary and short range missions 
unless a high degree of automation is achieved. An augmented Viking 
mission or a sophisticated sample return program aspiring to the explora- 
tion of a region of 500-1000/cm diameter would require the availability of 
an autonomous rover requiring only occasional earth control. 

In looking forward to detailed unmanned exploration of the planets, 
there are two prerequisites. First is the requirement that a high mobility 
rover or relocatable device be available. The higher the mobility (or 
capability of the device to deal with irregular and difficult terrain 
features), the more available will be the paths to the desired targets. A 
rover of low mobility may well find itself with no acceptable paths in many 
instances . 

Second, a path selection system of capability comparable to the mobility 
must be available. By path selection system are implied: (a) whe terrain 

sensor(s) which are to acquire the necessary terrain data, (b) the terrain 
modeler which is to process the acquired data with the goal of describing 
the terrain features, and (c) the path selection algorithm to determine the 
specific path to be followed towards the target. Unless the path selection 
system can take full advantage of the rover's terrain negotiating capabilities, 
such a mission will be made unnecessarily lengthy in time, or desired objec- 
tives will not be achieved, or, in the worst case, the rover will be im- 
mobilized when in fact passable paths are available. On the other hand, if 
the path selection system is insufficiently discriminating, the rover may 
follow a dangerous path with the risk of a catastrophic accident. 

The research program described herein has been directed towards 
problems of path selection including data acquisition and processing, path 
selection algorithms and the corresponding integrated path selection systems. 

The program involves two major tasks: (a) terrain and obstacle detec- 

tion and interpretation and (b) path selection system simulation. 

The task of terrain and obstacle detection and interpretation is aimed 
at investigating alternative procedures for using range-pointing angle data 
such as might be obtained from a laser rangefinder with the goal of closeting 
discrete obstacle hazards and/or impassable terrain contours. Included in 
the investigation are the effects of data density in space and time as well 
as of measurement errors inherent to the sensor and ,;o the dynamical motion 
of the rover. A major emphasis is being directed to the mathematical pro- 
cessing of the data to reduce computational requirements and to increase the 
amount of useful information derived from the measurements. Although the 
study is aimed at the mid-range of 3 to 30 meters, it can be extended with 
very modest effort to longer ranges. Thus it could be used as the basis for 
optimization of long range path segments. The sub-tasks which have been 
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completed to date include implementation of the simulation of the Rapid 
Estimation Scheme on an interactive graphics computer system, develop- 
ment of the mathematical procedures for using a Bayesian Estimate of 
States and Inputs for obstacle detection and estimates of laser range- 
finder accuracy for Mars rover applies*"* xuese studies are summarized 
briefly below and are described in more dela-c 1 in the reprints of three 
papers which are included. Future work will be directed to the application 
and evaluation of these methods with respect to reducing data rer uireiuents 
while retaining performance levels. 

The second major task, namely, path selection systems simulation and 
evaluation, has the objective of appraising the effectiveness of alterna- 
tive integrated path selection systems including the sensor (s), terrain 
modeler and path selection systems with data errors due to the sensor and 
vehicle dynamics. The simulator is a digital computer code capable of 
generating three-dimensional terrains of a broad variety on which can be 
superimposed a wide range of discrete hazards. The simulation affords the 
opportunity to screen, evaluate and modify alternative concepts prior to 
implementation in hardware. To date, the simulation has been modified to 
reflect a laser range finder of the type required to employ the Rapid 
Estimation Scheme and the mathematics of the edge detection procedure. 
Consideration has been given to a path selection algorithm suitable to 
this type of data. The progress which has been made is detailed in a 
following section. Also appended is a paper describing the use of the 
simulation in evaluating a short range hazard detection system based on a 
triangulation concept which suggests the effectiveness of the procedure. 
This paper is based on work supported by NASA Grant NGL 33-018-091. 


Task A. Terrain and Obstacle Detection and Interpretation 

Task A.l. Simulation of Edge Enhancement Technique - K. L. Leung 
Faculty Advisor: Prof. C. N. Shen 

An edge enhancement technique for the detection of discrete obstacles 
such as boulders and craters using a Rapid Estimation Scheme in conjunction 
with a Kalman Filter has been developed. In order to increase the re- 
searcher's effectiveness in perceiving the effects of orientation, form ol 
hazard, data spacing and sensor error on the obstacle detection concept, the 
technique has been programmed on the IDIIOM/Varian Interactive Graphics Com- 
puter System. The Rapid Estimation Scheme not only is shown to be capable 
of detecting the top edges of boulders and the near edges of craters but 
along the bottom edges of boulders and the far edges of craters. The simula- 
tion is now an operational tool which will be used to explore the detection 
concept in detail It is described in detail in a reprint of a paper which 
follows below. 
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PRESENTED AT THE SEVENTH ANNUAL CONFERENCE ON MODELING AND 
SIMULATION, PITTSBURGH, PA., April 1976 and Published in the 
Proceedings of the Conference 


SIMULATION OF OBSTACLE DETECTION SCHEME FOR MARS TERRAIN USING MINICOMPUTER* 


ORIGINAL PAGE R 
OF POOR QUALITY 


K L. Leung and C. N. Shen** 
Rensselaer Polytechnic Institute 
Troy, New York 12l8l 


ABSTRACT 

Simulation for detection of obstacles cn Martian 
Terrain is achieved by a rapid estiration scheme cn 
Varian Data 620/ i cor.puter with IDIIOM display. 
Sufficient info’v.ation can be obtained to recognize 
the near and far edges of pyramids, hemispherical 
craters cr boulders, and the combination thereof. 

INTRODUCTION 


boulders, craters, and other obstacles. 

OBJECTIVE 

The objective is to evaluate the performance cf the 
obstacle detection scheme cn a minicomputer. This 
paper simulates the Scnalkar-Shcn Obstacle Detect- 
ion Scheme on the Varian Data 620/i computer, mak- 
ing use of Sher and Shin's display subroutines for 
parameter, tcpviev, and edge image displays. 


An autonomous roving v^bi|Cle is to be sent to Mars 
for future exploration 1 . A laser rangefinder 
having an accuracy of d 10 centimeters, will scan 
an area ahead of the rover. An obstacle detection 
scheme will therefore be r>®#ded to process these 
range data to obtain complete outlines of distinct 
objects . 

One detection scheme that has been developed by 
Feed, Ranyal and Sher.t^j :..ckes use of the four- 
directional Laplacian method. This scheme works 
veil in detecting top edge of a boulder and near 

edge of a crater but it fails to detect the bottom 

edge of a boulder end the far edge of a crater. 

The scheme can only detect large Jumps in ranges, 
but not larce Jumps in slopes. 

The above scheme was simulated cr. both the IEM 360/ 
67 computer ar.d the Varian Data 620/i computer by 
Sher ar.d Sher.l3]. Or. both computers, the range 
data were generated by a searching scheme and then 
Gaussian r.cise was added to the range data to sim- 
ulate the actual range. In the simulation with the 
Varian Data computer, er. IDIIO?' graphic cathod-ray 
tube was employed to display the parameters, the 
topviev of obstacle layout ar.d the results for 
edge image. A light pen was also used by the oper- 
ator to interrupt the display end to change the 
parameters . 

Another obstacle detection scheme was developed by 
R. V. Sor.alkar ar.d C. N. S^nf* 1 ] vhich uses a 
Rapid Estimation Scheme^ *-] (R.E.S . ) in conjunction 
with Kaln>." Filter. In the simulation cn the IBM 
360 /67 computer, their scheme was shown to work 
extremely veil in detecting complete edges cf 


• Research sponsored by NASA Grant, NSG-71?L 

•* Frcfesicr-Ilcctrical !■ Systems Engineering Dept. 


The reason for this simulation is two-fold. First- 
ly, this enables easy parameter changing with light 
pen and teletype. Topvicvs of obstacles ar.d the 
resulting edge images car. be seen ar.d the differ- 
ences observed. The operator will then change the 
parameters accordingly end repeat the simulation. 
This means that the simulation can be dcr.c adapt- 
ively. 

Secondly, the possibility of implementing this 
scheme cn a small computer such as the Verier. Data 
must be ascertained. 

EQUATIONS FOR OBSTACLE DETECTION 

The range data arc given by the matrix R with the 
following elements : 



•d 

1 

* r m2 


' mn 


r a-l ,1 ' 

• s 1 
rr.-l 

2 

* si-1, n 

?* 

.... 

. . . 

• r u • * 

.... 

A 

i 

• • • • 
- r M * * 

• • • 

r i-i,j 

• * * * 


U 


is the range data for the terrain, th« 


length of the laser beam from the ground. The in- 
dices i and J indica*e the location in the angle 
of elevation, 6., and azimuth angle, 7ne 

1 a/ 

quantity r, , is the sum of the actual distance be- 
tween the transmitter ar.d the point cr. the greu-.d 
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and the Gaussian noise Sue to the inaccuracy of 
• the laser rangefinder. Hence 

: r u “ d ij 4 v ij (2) 

, The range matrix R is processed both along all 
i columns and across all rows. When processed vert- 
ically up a column, it is expected to detect Jump 3 
. In both range and in slope, a tvo-dimcnsional 
state vector is defined. The first component is 
the range and the second is the difference in 
successive l range data g^( slope) where 

! R i ’ d i+r d i 


method, the (x,y) coordinates of the point where 
the beam hits the terrain is determined. If the 
height of this point is z* and the height of the 
rangefinder is D, then the true range reading d. 
is given by ^ 

d i j=(D-z*)/sin(P i ) (10) 

Note that if the beam does not hit any obstacle, 
z *=0 and 


d i j=D/sin6 i 

These are illustrated in Figures 2 and 3. 


( 11 ) 


CAPACITY OF MACHINE 


The quantities g. , d . ,8 are illustrated in Figure 
1, 0 is illustrated in Figure 2. 


Along a column, the J index is held constant. The 
state equation is given as follows by omitting the 
index J. 


3 W r iW D \ 5 ik 


<M 


The measurement model is 
r 


'i +1 


H x i+l * v i+l 


(5) 


where 

x = 

'V 

1 

; F = 

" 1 

1 

i 

. F i. 

’ i 

0 



; h=[i o) 



( 6 ) 

U K =Jurp in g^ due to an edge 


It can be shown that for a flat plane, 
1 ♦/IS tan R.^ 
f i “ 1-246" cot Sj 
Also jl for i ■ k 

d ik j 0 for i i k 

which is a K.-oenecker delta function. 


( 7 ) 

( 8 ) 


Vectors w ar.d v represent plant and measurement 
noise respectively. The quantity v i accounts for 
the deviation of the model from the actual state 
equation. The quantity accounts for error in 
the rangefinder. 

RANGE DATA AND NOISE GENERATION 

The surface of each obstacle within the scanned 
area is described by its own geometric equation 

f(x,y ,z) = 0 ( 9 ) 

If the point cn the ground right underneath the 
laser mast is token as the origin, then a level 
plane with no obstacle is described by z* 0 . 

To determine the range reading with azimuth angle 
9, and angle of elevation f ( , imagine a laser beam 
at these angles. The height H and (x,y) coordin- 
ates of a point on the beam a small distance away 
from the laser rangefinder Is calculated and this 
height is compared with the height z of the terrain 
with the same (x,y) coordinates. If H is greater 
than z, then H of the point one increment down the 
beam is calculated and compared w<th z of the 
corresponding (x,y). The procedure is repeated 
until z is greater than H. Using a bisection 


The computing, machine used in this simulation is 
the Varian Data 620/i. The memory of this computer 
when expanded, is a limiting 32767 words, or rough- 
ly 32K. The operating system used in this comput- 
er takes up about ItK. Hence the available memory 
is only 28K. For comparison, the memories re- 
quired by the various programs are tabulated cn 
Table 1. 


Sonalkar 

Sher- 

Leung- 

Shen on 

Shen on 

Shen cn 

IBM 360/67 

Varien 

Varian 

Papid Estimation Scheme 8 K 

U-directional w/0 Display 

22K 


b-directional w/ Display 

28K 


R.E.S. w/Display by combin- 

ing Sonalkar and Sher 


3«K 

R.E.S. w/Display after 

Improvement 


27. 5K 


TABLE 1 

The Memory Requirements of Various Programs 


TECHNIQUES USED IN COMBINING THE PROGRAMS 

The original Sonalkar-Shen program that simulates 
the Rapid Estimation Scheme was written in Fortran 
suitable for the IBM ccrputer, which has a great 
deal of convenient features not found in the Varian 
computer. In order to run this program, cn the Ver- 
ian machine, these convenient features nust be 
changed to standard FORTRAN. 

After the two programs are made compatible, the 
four-directicnal LaplRciar. obstacle detection part 
in the Sher-Shcn program is taker, cut, ar.d the 
Sonalkar-Shen program, i.e.. The Rapid Estimation 
Scheme, i 3 put in. 

Each of the two original prorrnrs is very long by 
itself. After they are combined, the resultant 
program is too long and requires too much memory* 
3liK. Hence it must be improved by reusing some 
memory spaces after the numbers that are stored in 
these spaces are used. That is to say. two or more 
variables share the same memory space because they 
are stored in that space at different nor-overlapp- 
ing instances of time during the execution. This 
only accounts for a small amount of memory saved. 
The major reduction in the rem.ory requirement is 
achieved by storing the noiseless range matrix and 
noisy range matrix in the same memory spaces. 

Moreover, the spares set aside for the noise matrix 


«- page a, 
^ QUALITY! 
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In the original program is eliminated. Hence the 
noise is added to the noiseless range rending as it 
i is generated and the resulting noisy range reading 
is put back in the sane space, therefore erasing 
the noiseless reading. Here rrerory saving docs not 
come at no expense because the noiseless ran re 
matrix and noise matrix can be retrieved as two 
separated matrices from the noisy ranpe matrix. 

PROCEDURE OF SIMULATION 

The IDIICM displays three separate pictures, the 
specification, the top view of the layout and the 
edge enhancement . If no interruption occurs in 
the display process, the Varian b20/i will use the 
initial parameters for all calculations. The lirht 
pen is used to interrupt the processinr by pointinp 
at the parameter that one desires to change. The 
new value cf this parameter is entered through the 
teletype. The Varian 6 20/i will then use the new 
data and continue the processing. The picture on 
d‘ ploy can be replaced by -nother picture by 
pointing the light pen a. the appropriate character. 

The inputs to the computer a*" the dimensions ar.d 
locations 'f the obstacles (the dimensions of the 
obstacles not used will be zero), the height end 
location _>f the laser ranrefinricr, the maximum and 
minimum azimuth angles, the maximum and minimum 
angles of elevation, and the standard deviation of 
the Gaussian noise used. The above input parameters 
have initial values as specified in Figure b(a). 

They can be changed through the use of the light 
pen and the teletype. 

With the input parameters, the program then displeys 
the tep view of the obstacle layout cn the IDIICM. 
When the display is interrupted by the light pen, 
the program then calculates the range data using 
Eq.'s (10) end ( 11 ) . 

With the noisy range data and the noise covariance, 
the program processes the range data to detect the 
complete edges of the obstacles, usinr the Rapid 
Estimation Scheme, i.e., Eq* ' r- (l) through ( 8). 
Eleven cases are simulated. The values of the in- 
puts for each case are shewn in Table 2. 

NUMERICAL RESULTS AND DISCUSSION 

Eleven cases were simulated. Each case is a differ- 
ent combination of obstacle sices, locations, and 
noise parameters. Seme have single obstacle and 
sen* have multiple obstacles. For each case, the 
parameters, topview, and edre enhancement are dis- 
played. The values of different parameters are 
shown in the parameter display. The layouts of the 
obstacles are shown in the tepviev displays and the 
edge enhancement results, i.e., the edge imares, 
are shewn in the edge enhancement displays. The 
parameters are chosen to illustrate the effects of 
the charge of noise covariance, obstacle sices, and 
the distance between obstacles and laser for use in 
the Rapid Estimation Scheme. Some of these eleven 
cases are shewn in Figures b-10. 

In Figure b(c), case Ho. 1, only the tep edge of 
the 1 meter radius hemispheri cal boulder at 1C 
meters from the laser rangefinder (L.R.F. ) con be 


detected because the obstacle is tco clcse to the 
L.R.F. and hence the cignal-to-noise rotio (SHP) 

Is small with 5 cm. noise standard deviation. In 
case No. 2, the noise standard deviution is in- 
creased to 10 cm. and everything, else is the same 
as In case No. 1. 

In Figure 5, case No. 3, the complete edge of the 
boulder at 20 m. from L.R.F. Is detected for noise 
with standard deviation equal to 5 cm. In case 
No.l» end cese No. 5, the simulation is repeated 
for care No. 3, except that the noire standard 
deviation is new 10 cm. and 20 cm. respectively. 

The performance is very good. In Figure 6, case 
No. 6, the complete edge of a 1 m. radiu3 hemis- 
pheri cnl boulder at 30 m. from L.R.F. with a noise 
standard deviation of 5 cm. is detected. The edge 
enhancement result is better than that of the some 
boulder with the some noise at 20 n. from L.R.F. 

In case No. 7, the noise standard deviation 0. f is 
increased to 20 cm. In this case, the bottom’ edge 
is not co well defined. Case number 9 is 

a hemispherical crater with 1.5 m. radius at 12 n. 
from the rover, with c.. equal to 5 cm. The far 
and near edges of the crater are detected but seme 
noisy edges are picked up in the background. 

Figure 7, case No. 8, is an equilateral pyramid of 
height 1 m. at 20 n. frem the rover, with 0,. equal 
to 5 cm. and 10 cm. respectively. Here R.F.S. 
does not work too veil. The top of the pyramid 
gets truncated. 

Case No. 10 (Fig. 8) ar.d case No. 11 respectively 
arc multiple obstacles having a hemispherical 
boulder, a hemispherical crater, and a pyramid 
with their sizes and locations shown ir. the topview 
and parameter displays. The a., ir. case No. 10 and 
11 are 5 cn. and 10 cm. respectively. Complete 
edges of all three obstacles are detected for the 
case with a smaller c„. For the case with a larger 
o„ , the far edge of tnc crater and the bo*tom edge 
of the pyramid are not detected. 

CONCLUSION 

It car be concluded that the Rapid Estimation 
Scheme vorks very veil in detecting complete edges 
of obstacles if the obstacles are far enough from 
the laser rangefinder (> about 15 meters • ar.d the 
noise standard deviation is not too large ,<r about 
10 cn. This scheme can still detect top edge cf 
boulder ar.d near edge of crater if the obstacles 
are too close and noise standard deviation is larg- 
er than 10 cm. Therefore, the Rapid Estimation 
Scheme is equivalent to or better than the frur- 
directicr.al Laplacian schere in performance. How- 
ever, the former scheme needs slightly more comput- 
ation than the latter. Therefore, the P.L'.S. ex- 
tracts more information from, the r.oi3y rar.re matrix 
if the slightly larger number of computation is 
allowable. 
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Task A. 2 Detection of Discrete Obstacles - R.V. Sonalkar 
Faculty Advisor: Professor C. N. Shen 

There are many potential methods which could conceivably be used to 
detect discrete obstacles on a terrain. The major objective of this 
task is to enhance the outlines of obstacles in a two-dimensional perspective 
view from a set of laser rangefinder data contaminated by measurement noise. 

A large discrete jump of the first differences of noisy rangefinder data 
will outline certain edges on obstacles (i.e. top and sides of a boulder and 
near edges of craters or crevasses). The Rapid Estimation Scheme can deter- 
mine this jump of input under a sub-optimal condition by erasing all of the 
previous memory of the covariances of the Kalman Filter at the stage where 
the jump occurs. The present task has been aimed at retaining the past 
memory in the Kalman filter at the time during the estimation of the jump of 
the input and thus improve the estimate. The mathematical procedures re- 
quired to achieve this objective have been developed and are described in 
detail in the reprint of the paper entitled "Simultaneous Bayesian Estimate 
of States and Inputs" which follows. 
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PRESENTED AT THE JOINT AUTOMATIC CONTROL CONFERENCE, July 1976, 
at Purdue University. Proceedings of the same conference. 


SIMULTANEOUS BAYESIAN ESTIMATE f STATED AND INEUTS 


R. V. SonalVar, Member IEEE 

PATTE7.N ANALYSIS AND RECOGNITION CORP. 

On the Mill • 

Rone, New York 13“U0 


C. N. Shcn, Professor 

Electrical and Systems Eng ineerinr, Dept. 
RENSSELAER POLYTECIINICAL INSTITUTE 
Troy, New York 12181 


ABSTRACT 

This paper describes a Simultaneous Eavoaian 
Estimate (S5E) of states and inputs. J.it discroto 
system under consideration is ccsume* to .5 cu_.cc. 
to unknown inputs, isolated or repeated. The ill 
is conditioned on the hypothesis that an jrput 
occurs. It is mainly downed to impreve the 
Rapid Es.ifiticn Scheme (RES). fl.?1 which relics 
upon pattlrs a minimum voriar.ceTiTv j input osc.ruto. 
The SBE obtains an estimate of the input and also 
provides a proper correction to the existing state 
estimate, as opposed to th: current RES which 
mc-ely obtains a t*V input cstim-.te. The approach 
in RES vc s shewn to be sufcoptimal in ?cf. £lJ. 

The SUE is proved to be existent under cos.mtions 
which were imposed for obtain!:." the !'V input 
estimate; i.c., it does not ir-fcan any more restric- 
tions or. the systems th.ct rap* he considered, ."-n 
the ones that already existed. Since the STE is a 
conditicr.il osoi-ute, ft decision scheme is rceuirsc 
to determine if the unknown jr.puts are preser. .. 
3ayes decision rule used fer such a purpose has ice: 
described in Ref. £lj cr.d is not repeated in this 
paper . 

NOKENCLATU-E 


n 

N(m, 


p(y./ 


v . 

i 


Dimension of the state vector x^ 

E) Normal distribution with mean vector m 
and covariance matrix Z 
(nxl) Vector with all cere elements, 
r.- null vector 

Covariance of the state estimate x^ 
h ) pdf of x conditioned on h 

Dimension cf the input vector u , 

I.ust sta^c at which an input occurs in 
a sequence 

(sxs) Observation r.cise covariance rat: 
Dimension of the observation vesper r.^ 
(cxl) Input vector 
(cxl) V.'CN sequence vectcr 


Alphabet 

icol s—bols 

V L 

(nxl) «G plant cr system noise sequ 

3 

(rucq) Input distribution matrix 


vector 

Cov(x) 

Covariance matrix cf th* rar.de- variable x. 

x i 

(nxl) State vector 

ECx) 

Statistical expectation cf x 

X i 

(r.’q)xl Augmented state vector 

r 

‘ i 

( -xn ) State transition or system dynamics 


nxl Component vectcr 

matrix 

y 2 

qxl Component vectcr 

» ! i 

(rxn) Measurement matrix 

V 

(n*q)xl Join' *.cotcr of y, and y. 

r. 

Hypothesis 


(cxl) Observation vectcr 

K 

truer.) Identity matrix 



n 

k 

Tirst stc C e a' which input occurs in a 

Greek 

Symbols 



4 ij 

Xrceneoker delta function *1 if i=* 


sequence 



M i 

Covariance of the predicted state vector x^ 

0 

O if i/j 

Matrix defined by Eq. ( 2 l *t> ) . i r.ver 
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auc“«"tcd state ecci"sce covjriar.ee 


10 . 


0 (A) Rank of matrix A 
¥ Matrix defined by tq. (P) 


Subr-criots 



Time stage subscripts 

n, n+q 

Dimensions of null-vectors 0. 

Superscript* 

T 

Matrix transpose 

* 

Cunntity related to augmented system 

1.0 

Hypotheses 

Special 

f\—bo) s 

x i 

Best estimate of :<^ 

x . 

Predicted estimate of 

Abbrevi 

iticns 

Kr 

Kalman filter 

KaP 

Maximum A Posteriori 

KV 

Minimum variance 

pdf 

Probability density function 

p.cs 

Rapid Estimation Schemj 

SBC 

Simultaneous Hayes iar. Estimate 

WGH 

White Gaussian Noise 


IMTROL'.'CTION 

The amplication.. cf the CJiun filter have 
been extremely varied in numerous fields such as: 
satellite, aircraft, ar.d ground vehicle tracking; 
feedback process control; irage processing; edge 
detection; etc. The extensive use cf the filter 
to obtain estimate* of th" s* "os cf a system hc3 
also r.ar.if '•ctcd its shortcc - ~t. The filter is 
optimal only if the system pa: imctors are known 
correctly. Cn the other hand, uncertainties in 
the system dynamic: ar.d noise statistics often 
cause the filter to divert":, if r.o safeguards are 
introduced to detect and prevent such a runaway 
condition. Sudden changes in the states of a 
systc-, which may be encountered while tracking a 
maneuvering target, also result in throwing t.:t 
filter eff-track. These difficulties are in- 
creased -ihen tracking multiple targets with 
multiple radars. 

uhJMNAL PAGE B 
01 POOH QUALITY 


Such changes can hr -odcllcd cr i related 
inputn to the system [ 1,^1 t<r sequences cf inputs 
[?2 added to the state. In general, the dirf« rmco 
equation for the states of a system subject to 
unknown inputs can be written as fellows: System 

dynamics : 

*i.i * r :*i * “i 

Observation equation: 

*i.i ■ "i.iVi ’ 

where x^ and w, are n-vectors; is ar. unknown c- 

vector; z^, and v.^. are s-vectors; H, + ,, 3, and 

r i ore known matrices of compatible di-ensicr.r. . 

Vectors w ( and v ; are WG?l sequence vectors. Th* 

plant noise vector w., the observation noise 

vector v ; , and the initial state x q arc all assumed 

to be uncorrelatcd ar.d of known distributions; the 

distributions being fKO^, O.), C 0 = , ^ij y ’ 

a. id N(x , P ) respectively. Covariance 0, is 
oo A 

positive temi-dcfir.ito while and f<^ are positive 
def ini - , matrices. Here, and in the subsequent 
derivations , 0^ denotes a null vector of dim . nr ion 
Cr.xl), i.*., an r-voctcr with all zero eJricnts. 


r 

t 

j*k 


'“s 4 u 


m 


i*l 


(2) 


In the abscr.ce of the input term, the state 
x. could have been estimated optimally by the 
Kalman filter [m] . However, the presence cf the 
unknowns u Jt k, and r in Eq. (1) pose the problem 
to be solved. 


To detect such ar. input, it must be estimated 
at first. P.IS has used a subcptimal minimum 
variance input esti-tte which .-as been sr.cwn to 
exist if the following conditions are satisfied. 

a. q < n s (3a) 

b. Matrix (HB) is cf full rank (3b) 

The implications cf * u era two tor.ditior.s will be 
discussed in a later section. 

It has a’ so been shown in Sef. that the 
MY input er-ti-atc i. suboptir.il sine* - it is based 
on certain approximation*. -r.d « e certain condltior 
the KV input estimjtc also enur.es the filter to 
lose its "re-cry" by basing the current state 
estimate entirely cn the current observation. 
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Therefore, the advantage of hav inr, a smooth estimate 
until the Input detention takes place, ir. lost and 
subsequent estimator arc noisier. 


where x. in the beat unbiased cstirr.itc at stage i 
obtained from the observation 7- . 


In an effort to determine a better and possibly 
optimal joint state and input estimate, the method 
described ir. this paper was developed. The esti- 
mate retains the memory of the filter as opposed 
to the MV estimate which, under certain conditions, 
became a linited memory open-filter. The estimate 
has not been proved to be optimal, or even better 
than the previous MV estimate. However, because 
it has been derived from the basics without approx- 
imations, ar.d because it retains the memory of the 
filter, it is expected that the simultaneous 
Bayesian estimate would provid. a better filter 
perforrar.ee. 

The problem of detection is not described. 

The interested reader will find it in Refs. fl t 2.5,G] . 
The SEE is derived, conditioned on the presence of 
the input. A decision scheme will have tc be used 
in conjunction with this to determine whether this 
conditional estimate ir. correct. 

3AYESIAH ESTIMATE 

Two hypotheses are defined - 

: Input occurs at stage i. 


The error covariance of the unbiased a priori 
-0 

estimate is obtained from the system dynamics, 

Eq. (1). 

c ' x i+r x i+i ) (x i + r x iti )V;, ° ] 

= F i p i r I + Qi (10 > 


where ? L < x i’ x i' 3 (11) 

is the error covariance of the estimate x,. 


Substituting Eq. (7)^10 (2), the observation 
equation conditioned on h can bo rewritten in a 
different form. 


Z i+1 


H . , x . , + v . , 

l+l l+l i+l 


h J 


Input decs not occur at stage i. 


These definitions assume that the decisions 
between stages 0 and i-1 have already boon made. 


H 1 ' ,X. , + v. , 

i+l i+l i+l 


( 12 ) 


x. , -i'.x.-tw.'tUu. 

i+l ill i 


Ci) 


"i+l 


A II. , T 
• * i+l 


where 

and f is defined by Eq. (0). 


(13) 


x. ,=r.\.+w. 

i+l li i 


( 5 ) 


To obtain a MAP (maximum a posteriori) estimate 


1 0 


(6) 


Thus x^ + , is the partial state without the input. 
Defining, a new augmented state Eq Ci) can be 

rewritten in a new notation. 


* Cl n 

i+l n 


0 

X i+1 


u . 

i 


V X 


where [I 3] ; X. , 


i+I 


x i+l cx ^ ?ts - n t " c Forn °* the Kalman filter 
estimate a: stage i. 


. 0 , , -0 
. . i.(X. 2.) s X. , = F.x. 

l . i i+l i i 


(9) 


of x ,- +1 . the probability density function (pdf) of 

X. conditioned cn z. ,, must be maximized. Using 
i+l i+l 

the Daycs rule fer conditional probabilities C 11 ] : 


P (X i+l /z i+l } 


pU i+l /X i+l ) p(X i*l } 


P (z i + 1 } 


( 1 “) 


“i+l 


(7) 


0 



Since, the state x' 

X • , 
1+1 


(8) 

each other, p(X.^ 

u. 

. l J 



p(x° +i ) and p(u.). 

^ is the 

aug- 


orma Pion 

about 

•* ,p(X i+l / *i+l ) 


P( *i+1 /X i+1 ) p(, W p(u i } 


P (z i+1 } 


(15) 


We may consider u.^ to be normally distributed, IUu^ 
p^) so that the derivative of In p(u.) with respect 


to Xj, gives. 


12 


r* j ii p(u. ) 

yx: 1 


*u. _ 
- (?--) T 


F' 1 (u. - u.) 
u i i 


Tor normally distributed variables, Eq. (17) r. 
easily hr.- shewn to ho reducible to the following 
minimization. 


The input vector is assuned to ho deterministic 

and of unknown magnitude. Therefore, it may 

be considered as a random variable with covariance 

tending to infinity. Allowing P ■* “ causes 

LiHP( u i) -► o , [7] . This fact allows the 
d a £ n-tq ■ — 

maximization of p(X^ + ^/z^ + ^) to be expressed in 
the following form. 


a In 
3 X 


i+1 


pt WW 


hn 


iii p(z i*i /x iti ) 

“i.i 


+ 



r.+q 


(17) 


As is well f ’.m, the solution of this equation 
leads to the MAP cstim’te X. of the augmented 
state X. +1 . 


Irr [(z-H* X) T R' J (r.-!|A X)f(x-x) T M" 1 (x-x)3. = 0 

o a y n+q 

( 20 ) 

A x 

Since X=[— ], the minimization of tne second term 
inside the parenthesis can be performed as follows: 


-|^{(x-x) r M" 1 (x-x)] 


D_ 

3x 

3_ 

3u 


C(x-x)^M~*(x-x)] 


M _1 (x-x) 


(21) 


The last equality is due to the fact that x is 

independent of the input u. As a result, the term 

2— (x-x) T M - 1 (x-x) is equal to the q-dimer.sior.il- 
3 u 

null vector, 0^. Substituting Eq. (21) ir. (20) 


Eives : 

-H* T R“ 1 (z-II* X) + 


:, _1 (x-x) 


= o 


r^q 


(22) 


It is understood that all the puf's in Fq. 
(17) arc conditioned cn the previous observation 
, which permits the pdf of y.. to be completely 
specified by its mean, Eq. (3), and covariance, 

Eq. (10). The conditional pdf p(z. +1 /X. + ,) 
requires the following quantities. 




= H. , X. , 
i+1 l+l 


Ry further manipulations, cn expression for the 
Bayesian estimate X is obtained. 

X = X+ 

where X 


-1 


[ * ] = 
L 0 J 
q 


H* T R' 1 (=-H* X) (23) 
(24a) 


r/x? 
1 1 


L °q 


r 

’ -1 0 


. -T „-l 

M nq 


H* R H* + 



V 

0 C cc 

qn qq 

j 


(24b) 


(18) 


Cov. U ifl /X itl ) 


"i+1 


Before proceeding any further, let us suppress 
the subscripts fer convenience ar.d use the following 
rotation. 


i+1 


= x, X i+1 * X R, 


i+1 


M. * M 
l+l 


(19) 


u : 1 ^ i z i+i " ^i + x " ^ • ^i+1 " ^ 


ar. 



(24c) 


Even though similar in appearance, Eq. (23) bears 
differences in two striking details with the 
Kalman filter estimate. First, X given by Eq. 

(24a) is not equal to E(X) = [ E ^ x) ] as is generally 
true in the Kalman filter updating equation. 


Secondly, the matrix $ is invertible only under 
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certain conditions to be derived below. In the 
Kr equations, the error covariance P, which generally 
occurs in place of ♦ \ is positive definite by 

definition. On 'he other hand, SEE can be obtained 
only when $ is invertible when certain conditions 
are met. 


T 

then, using Eq. (2Mb), y $ y may be written as 
follows: 


T 

y * y 


T T -1 T -1 

y V*R 1 H* y + y M y. 


(28) 


Therefore, if * is to be positive definite, then 


Using Eqs. (8) and (13), the first term in Y 
is seen to be of the following form: 


T T -1 T -1 

y H 1 ' R H* y + y*M y 1 > 0 


( 29 ) 


h* t r _1 h* = v t h t p." 1 h y 


T -l I T -1 
= H R H I H R HD 

— - - - „ j 

T t i 1 T T - 1 

bVr - ‘!I ! B K R HB 


(25) 


The matrix in Eq. (25) is cf Jimcnsicns [(n+q)x(n+q)], 

but is of rank n. Since wc have assumed s >r., R 

T -1 

positive definite, and K to bo of full rank, H R _ H 
is positive definite. Moreover, Y is a [n x(n+q)] 
matrix, given by Cq. (G), and is of full rank. 
Therefore, T ‘ ll 7 u”*I! Y cannot he cf any higher 
rank than n. 


r hv 

n T R _1 i;ij 


1 

1 

H 

o 

1 

i 

i 


i nq 

T T 1 

i»Vr !! 

b t h* ! r” 1 iid 


0 ! 

0 



L qn' 

qqj 


must be satisfied for all (n+q) dimensional vectors 

V i o . Here y i 0 means that y is not equal 
J n+q 1 n+q 

to the null sector of (n+q) dimensions, i.e., y 
has u? least one non- zero element. 

Any non-null vector y, defined by Eq. (27) 
can have either y, = 0^ or y, i 0^. Putting those 
two cases together, wo cover all vectors y which 
arc non-null, i.e., y i ' 

i) If y 1 = ° n , then y 2 i 0^; since y ^ = 0^ and 

y_ = o simultaneously will make y=0 , which 

■>2 q wrq 

must be excluded for proving (29). Mow, inequality 
(29) reduces to the following after using Eq. 


In Eq. (26), both matrices on the right side arc 
positive sexi-definite and of rank n each. Hence 
the rank of $ cannot be greater thar 2n. Let us 
see under what conditions, $ can be a positive 
definite matrix. If $ is to be positive definite, 
y 7 ♦ v must be positive for any (n+q) dimensional 
vector y, which does not have all zero elements. 


If y is defined in terms of its n and q 
dimensional component vectors y^ and y 2 respectively, 
i.e., if 


V 


A 


’*1 

^2 


) n 

) q 


(27) 


(25). 


Y 7 3 T H 7 R' 1 H B y 2 > 0 (30) 

If this ir.ecuality is to be true for all y~ t o 

*■ q 

T -1 

then (HB) R A (HB), which is a (qxq) matrix, must be 
positive definite. This condition is satisfied if 
q^_n<_s in addition to (HB) being a matrix of full 
rank. Matrices H and 3 are of dimensions (sxn) and 
(nxq) respectively, so that the (sxq) matrix (H3) 
must be of rank q. Therefore, inequality (30) is 
true for all y_ / 0 if: 

2 q 

a) q<n<s and b) Rank (H3) •- q 


ORIGINAL PAGE iS 
OF POOR QUALITY 


I 


14 . 


ii) When i O r , may take any value, since 
y i 0 is satisfied by virtue of y, t 0 . 

Under this condition, inequality (29) remains un- 
changed. However, M ^ is positive definite, which 
T -1 

makes y^ M y^ 0 for all y^ i 0 r . Therefore, the 

sum of two quantities, one cf which is positive 
T -1 

(y H y 1 > C) and the other non-negative 
(y^ H* R - ^ H* viO), must be positive. As a 
result, under this case also, inequality (20) is 
satisfied . 


where 


E(X) 



E( x? ,) 


E(X| i 

i+1 

- 

i+i 

E(u £ ) 


u . 
i 


(33) 


Taking the expe ctation of Eq. (23) we get 


E 00 = E (X) + « " 1 H* T R' 1 E (z-H* X) 

= E (X) + * _1 I!* 1 R’ 1 H* E (X-X) (34) 

The last equ ility in (3 m) is obtained from Eq. (12) 
and from the fact that v. + ^ is a zero mean vector. 
Because x is an unbiased estimate of x: 


Putting these two cases together, the conditions 


are: 


the positive def init®r.ess of ♦ 

E (X) = 

' E(i)' 

= 

'E (x)' 

rank(HP) = q 


0 

q 


0 

q 

L J 


a) q £ n I s : 

b) M* 1 must he positive definite 


(31) 


(35) 


Using Eqs. (33) and (35) it is possible to write 


Conditions (31a) arc the same as (3a) and (3b) 
which were the necessary conditions fer obtaining 
the MV estimate in rl.'S. Also, t! is the error 
covariance of the KF' predicted slate x und in 
therefore positive definite*. Therefore, S3E dees 
not impose any additional constraints on the r liter 
for the purpose of obtaining the additional input 
estimate. 


the expectation of X 


X in the following form. 


E(X - X) 


r-H 

M 


E(x-?.)" 

- 

r 

0 

n 

i U 1 

0 1 


u 


u 

L J 

1- q - 


“ ^ 




IMPLICATIONS Cr THE NECESSARY CONDITIONS 

Due to the particular form cf E(X-X) in the above 

Here, we arc trying to rake a 'one-shot' esti- 
mate of the input vector without having ’he benefit equation, it can be easily confirmed that the 

of ' input -dynamics . ' Therefore, the filter necessi- 
tates the availability of sufficient observations by following identity is true, 
imposing the condition (qlnls). 


The requirement that ( H3 ) be cf full rank 
indicates that all the q inputs must appear in the 
observations. If rank (H'J) = c(H3)< q then it 

would mean that all of q input components do r.jt 
directly affect the observations ir. any way. However, 
they may do so through the states at subsequent 
stages ar.d may he estimated later . Therefore, 

( n(HD) = q) may be interpreted as the 'observability' 
condition fer the input. 


.i 

■> 



0 

nq 

0 

qq _ 


E(X-X )= 0 R+q 


(37) 


Adding this null vector to the right side of Eq. 
(34), we get 


Condition (31b) is not a new one and merely 
requires that a reliable prior estimate must exist. 
It is always true in case of -a properly formulated 
problem, as long as the system noise covariance Q is 
not caken to be a null matrix. * 


E(X) = E(X) t $ _1 


< 

" -i 

> 


M 0 


T -1 

H* R K* + 



w 

0 0 


l qn qq _ 

> 


PROPERTIES OP THE ESTIMATE 


E(X-X) (38) 


If the estimate (23) is to t>*. unbiased, it must 
satisfy the requirement 


E (X) = E CX) 


(32) 


But, the quantity in the brackets in this equation 
is 0 itself, Eq. (24b). Therefore, the required 


property emerges immediately. 
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L(X) = F(X) + K( X-X) : E( X) 


(39) 


RLrr.ur:ticr:s 


Py drawing analogies with the Hainan filter 
described in Kef. [»* 1 , the ft lowing quantities 
can be defined: 


Gain = K >' ! £ +1 


> H i+1 R i+1 


(90) 


Covariance 


pft 

r i=l 


.- 1 = E {(X lt .-* in ) 
(X i+l" X i+l ) ^ 


Using Eq. (7), corresponding quantities for the n- 
dimcnsional system of interest can be deduced. 


DISCUSSIONS 


The Bayesian estimate derived in this part 
can be calculated under condition:; which cun 
easily be satisfied, (31). In fact, these conditions 
were assured to be true even for obtaining the 
minimum variance input estimate in Kef . [1] ■ 
Therefore, the Dayesi-an estimate dc-'S not impose 
any new restrictions, and at the sane time, it 
makes use of the 'a priori' information in the 

form of x. , end K. Under certain conditions, 
i+l l+l 

this information was lost in the RES, [5] . 

No approximations were made and the Eq. (23) 
represents a valid and a correct Bayesian estimate. 
Even if Buyer.. -in estimation i:. not n new technique , 
its application to sircul tar.ecus state and input 
estimation is. Also, r.tute augmon ration has been 
used often in the literature for estimating biases 
and unknown tine-distributed inputs, but not for 
one-stage estimates. The scheme proposed here is 
to be employed in conjunction with a decision rule 
to estimate end detect any inputs, as they occur. 
Therefore, it is suitable for improving the per- 
formance of the RES where immediate detection of 
sudden changes in state (inputs) is considered 
equally ns important as obtaining a good overall 
state estimate. 

SEE still remains to be investigated further. 

The optimality or sub-optiraiity properties have 
to be determined under the orthogonality condition. 
The fact that SEE "stains the memory of the 
filter, gives a strong indication that it will 
give a much better state estimate in the presence 
of inputs. Further research concerning this 
approach and computer simulations of the RES 
incorporating the S3E are necessary. 
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Task A. 3 Estimation of Laser Rangefinder Errors - T. Ostroski 
Faculty Advisor: Prof. C. N. Shen 


The detection of discrete obstacles using laser rangefinder data 
involves the mathematical processing of range data contaminated by instru- 
ment measurement noise. The instrument noise should be determined in 
advance of specifying parameters to be used in evaluating a system for 
enhancing the images of potential obstacles. In the past the mean and 
variance of the noise were assumed and employed in computer simulations of 
the edge enhancement procedures. The actual determination of the statistics 
of the noise for an actual instrument was not attempted. 

The purpose of tMs task was to establish the actual noise statistics 
of an existing laser rangefinder. Methods ior determining the noise were 
developed and applied to a set of such data provided by Mr. Dobrotin of the 
Jet Propulsion laboratory. Details of the procedure and the results are 
provided in the reprint of the paper which follows. 
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I ABSTRACT 

I 

A method vas developed to determine the accuracy of 
a range finder when errors exist due to the test 
setup. An analytic procedure was developed to 
evaluate actual data from a test performed on the 
laser rangefinder for the Mars rover project. 

INTRODUCTION 

The laser rangefinder and a television camera are 
i two alternatives being considered to supply the 
I data for the terrain modeling, obstacle detection, 

, and path selection systems for the Mars autonomous 
' rover. The advantage of the laser rangefinder is 
; that actual dister.ee to obstacles car. be found. 

| Therefore, it is important to know the accuracy of 
, the rangefinder. The actual data, which is used 
in this paper, vas taken from a test on a prototype 
j rangefinder constructed at the Jet Propulsion Lab 
as part of the Mars Rover F -oject. 

STATEMENT OF THE PROBLEM 

! 

, The problem is to estimate the accuracy of a rar.ge- 
: finder given the data from an actual test run. The 
! field of scan for this test is a flat plane with no 
obstacles. If obstacles exist they must be remov- 
| ed from the rar.ee data set. The inaccuracies in- 
i volved in the test scan ccr.e from many sources of 
! error. These sources of error are in the device 
1 Itself end possibly ir. the test setup also. A r.y 
errors due to the test setup must be eliminated in 
the estimate of the error for the device itself. 

THE RANGE LATA MATRIX 

i A diagram cf the scanning device relative to the 
scanned area is shown in Fi gure 1. Point A is the 
scanning device itself. Point B is the point cr. 
i the line, A3, which intersects the hcrizcntal_ 

' plane that includes the scanned area. Line AB is 
1 perpendicular to this plane. Z is the distance 
i from A to 3. 

\ Although a rectangular coordinate system is given, 

I the scanning scheme is in a spherical cccrdir.ete 
! system. In figure 1, the elevihion angle, 9, and 
the acimuthal angle, i, are divided into steps. 

■ The sloe of the steps are 10 and id for the elev- 
' aticr^ step and asimuthal step, respectively. The 


actual position of the rectangular coordinate sys- 
tem is arbitrary (the coordinate system has d_^ 
equal to 0° from the y axis for convenience)." 


I 

| 

The data matrix, R, . , is an n x n matrix, where r. 
is the number of elevation steps ar.d n is the num- 
ber of azimuthal steps. The quantity, R.., corres- 
ponds to the i*^ elevaticn angle step and J the Jth 
azimuthal angle step. Therefore, P., , corresponds 

to 9 . ar.d d . end R ccrrespends“to 6 ar.d 
min min mn max 

V.ax‘ 

METHOD OF ANALYSIS 

Two approaches are giver, in this section. The 
choice of the method depends uper. how veil the test 
setup has been calibrated. 

1. T«o-Dircnsicna2 Accuracy Analysis - Fcr an ideal 
.test setup, all range data values fcr a given ele- 
vation angle should be equal. That is, if the axis 
of the rangefinder is perpendicular to the horizon- 
tal plane, varying the azimuth angle with a constant 
elevation angle will sweep an arc of a circle on the 
horizontal surface with the center at point B. 


Under this condition, the data for all azimuthal 
angle steps at a given elevaticn angle car. be aver- 
aged for each of m elevation steps. Tr.ese m aver- 
aged values are called ?., and are computed by the 
following equation: 

R . « — l R. , (1») 

1 “i j-i IJ 

where n, is the number of range data points ir. row; 

The R\ can be plotted to create a two dimensional 
profi.e of the range data. This plot is useful for 
a visual inspection of the linearity of the e.eva- 
ticn mechanism. The standard deviation, S, , can 
then be calculated fcr the data points in each rev, 
i, using the R , , ir. the fcrcula: 


(lb) 



A least-squares fit to the two-dimensional plot is 
valuable fcr this problem. It can provide a better 
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•analysis of the non-linearity than a visual inspec- 
tion. Also, -value# of Z and , -which are ehovn 
'in Figure 1, can be calculated from the fitted line 

and compared to the values measured for the test. 

! 

In the least-aquares fit, the estimated equation Is 
■of the form: 

I ¥_■ .au _+j9 UL . 

,To facilitate the estimate, another coordinate 
•ystem was used. This transformation is shown in 
Figure 2. In the u W coordinate systen, the range- 
finder (point A) is the origin; and, to eliminate 
®nin from the analysis, the mean value for the 
! first elevation angle value is placed on the 
lu axis. 

:Hie values of u 


end V. can be obtained from the 


mean values, R < ", of th£ rows of R. by the follow 
■* ‘ ~ elevati 


ing equations , ‘where AO is the 

Geoin text of 

i 


^•cos((i-l)A0] 


5 1 sin[ (i-l)AO] 


on step size: 
(3a) 
(3b) 


.The equations used to calculate the values of a and 
.b in equation (2) can be obtained from a probabil- 
ity [l] or computing methods text under the head- 
lings, "linear regression". They are as follows: 

• JLvt -‘Ivd v 


i-i 


i«i 


i»i 


» l l “!>' 


- m v U 

i l V, - ± l U 
Vl 1 “ i=l 1 


(U) 


(5) 


!The estimated value of 2 is computed using_the 
•fact that slope of the lfne in Figure 2 , AS, is 
ithe negative of the reciprocal of the slope, a. of 
ithe estimated line. The equation for the line AH 

j** v * - ~ u (6) 

; Solving equations (2) ard (6) simultaneously, the 

: coordinates of point B, u and v 

o c 

ab 


I+a 

b 

1+a 2 


are obtained: 

( 7 ) 

( 8 ) 


'The length of Z can then be calculated by taking 
•the square rootof the sum of the squares of u and 
;V o from equations (7) and (8): 




(9) 


!The 0^ c can be calculated using the value of Z^ 
and b. c The angle between the v axis and A3 in 
Figure 2 is equal to 0^^. Therefore, ^ can be 
•calculated as follows: 

. Z 

i 8 . * arc 008 >r (10) 

min c 

:The differences, e, , between the actual R< values 
•and the estimated line shown in Figure 3 are very 
useful for analysis. To calculate, e, , the equa- 
tion of the line that passes throuSh the origin 
is determined. The equation for it is: 


V • u [tan dP(i-l)] 


( 11 ) 


If equations (2) and (ll) are solved simultaneously 
for “tr, “the value~is-ca21ed'U* '"and is given in the 
following equation: | [ 

•. i tne tnis pou' ■ r ** , . , — • (12)' 

' i tan A0(l-l)]-a '“ , l 

♦ 

• and then the horizontal projection of the error, 

— Ce u ) r -1*- ! 

Finally, the errors, e . , between the P. and the 
fitted line, are calculated by dividing (e ). by 
the cosine of (i-l)A0: 

•i "'“l - t.nUo(l-li]-. (ll)' 

; 2. Three Dimensional Accuracy Analysis - The three- 

dimensional accuracy analysis is desired when there 
is a "tilt" in the test -setup. In the two dimens- 
ional analysis, any such "tilt" will show up as an 1 
apparent increase in the error for each row. 

The methods in this section also compute the "tilt" 
so that the rangefinder can be aligned to be per- 
pendicular to the horizontal plane. A visual in- 
spection of the range data points can reveal whether 
or not there is a "tilt". General trends of in- 
creasing or decreasing values of R< , as J goes from 
1 to n, indicate that a "tilt" exists. 

The range data is given in a polar coordinate system 
so the data must first be transformed into the X, 
y, z coordinate system shown in Figire 1. The con- 
version formulae are: 


where 


u 

>u 


•j 


■ V“* V C05, j 

■ Sjj'cos 9.) slMj 

■ V 10 V 

* <‘-D« 

(J-1)A0 


(15) 

(16) 

(17) 

( 18 ) 
(19) 


The plane which contains the range data points can 
also be estimated by a least-squares estimate. The 
equation of the plane will be: 

z * w x + w .y * w, (20) 

1 c 3 

The objective function that must be minimized is: 

J ’ I j 1 u ir ( Vij*Vij* v 3 )l2 1211 

Taking partial derivatives with respect to the co- 
efficients, v , w 2 , v , and setting them equal to 
zero: 

ve obtain; 




( 22 ) 


The matrices are defined as: 

t 


P - 


ZZX iJ 
ZLX iJ M iJ 
rixij 

rrx iJ : U 
ZZ2 u • 


tZx ij ?/ ij 

ZZ{/ iJ 


i:x 


ZZu 


(23) 
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V ■ 

1. 

< < 1 

- _ - m -n '• — 

and II Is I I 



i«l J"1 . . . 

(25) 


These equations can be solved using a matrix solu- 
tion routine to find the coefficient vector v, if 
Q Is nonsingular. 

The actual range data can be corpared to the esti- 
mated plane by generating the values of range data 
that correspond to the estimated plane. These 
range values are called P... The equation for R. . 
is derived by substitutlng-eouations (15), (l 6 ) 
and (17) into equation (20) and solving for R, : 


U 


sinC^cosS^fv^cosOj+v^sindj ) 


( 26 ) 


vhere 0 ^ and 6 , are given in equations (^ 8 ) and 
( 19 ) • This primed range data matrix, F, , can be 

subtracted from the original range data matrix. 


Rjj, to form an error matrix. 




U 


R ij' R iJ 


(27) 


The R* matrix shovs the difference betveen the 
estimated plane and the original data. 

Using equations (26) and (27) the matrices, R and 
F* values vere calculated. The P.*, values vere 
manipulated to provide more useful* ‘lata. First, 
the values vere averaged in each rov and called 


n. 


I 

D i J-l 


1J 


( 28 ) 



vhere n^ is the number of data points in rov i. 

Next, the standard deviation of the values in each 
rov, s», vere calc ulated usin g the fclloving 
equation: 


(29) 


The values for r* and S* are ehovn in Table 1 . The 
means and standard deviations, calculated in the 
three-dimensional analysis, correspond to R, ar.d 
S 4 , calculated in the tvo-dirensional analysis. 

The starred values, hovever, are computed taking 
the "tilt" into consideration. 

The direction of the "tilt", as projected cn the 
• X, y axes, is needed to align the rangefinder. 

This direction, i, shovn in Fig. 1, can be comput- 
ed by taking the gradient of Fqua. (20). The vec- 
tor d is giver, by 

iT 


d ■ [Vi v 2 r 

If no tilt exists, d vill be a zero vector. 


(30) 


a digital output signal. Fix values ate measured 
• for each position; the final five are averaged to 
get the range value f< r that position. The beam 
orientation is changed by Living a mirror that 
positions the laser beam vith tvo stepping motors. 
For the test data, there vere 30 elevation steps 
and 50 azimuthal steps. The range data set for the 
- laser rangefinder is shcvn in Fir. 3 . The range 
points that fell on an obstacle vere 3et eoual to 
zero so the computer programs for the analysis 
vould skip these points. 

‘ (2l 

The parameters for the test setup for this data 
are: Z = 636 . 0mm, AO. 3307 degrees/step, Ad**. 3059 
degrees/step, 9„., n *35.0l* degrees. 

The Results - The values of the mean, P , end stand- 
ard deviation, S. , computed from equations (la) and 
(lb) and number of data points for each rov of the 
range data are shcvm in Table 1. Using these mean 
values, R , and equations ( 2 ) thru ( 5 ), the least- 
squares estimate of the line passing through these 
points vas made: 

V - .62859 U* 792.95 (31) 

The estimated value of Z , using Ecua.(9), is 671.3 
am.. From Fqua. (10), th? estimated value of <5 
is calculated to be 32.15°. ^ 

The values of e^ in Table 1 shov the difference be- 
tveen the Pj and the estimated line in Fqua. (2) as 
shovn in Fig. 2. These values vere calculated us- 
ing Eoua. (lL). Any trends in the P ( values can 
be observed in the changes of the values of e^. 

This analysis vas given only as an illustration. 
There is a "tilt" in this range data, so the stand- 
ard deviations, , are not good estimates of the 
performance of the laser rangefinder. 

The "tilt" in the data can be observed in Fig. 2 
by comparing the left- and right-most columns of 
the range data. In 22 cf the 30 revs, the first 
element is smaller than the last; and in the other 
rovs , they are equal. This indicates that "tilt" 
probably exists and thit the three-dimensicr.al 
analysis should be applied. 

For the least-square estimate cf the plane of the 
data, the matrix equations , ( 22 ) thru (25) vere 
solved for the vector, v. Fquation (20) fer this 
estimate is: 

. 039U6 X* .03383 i/* 6 78.0 (32) 

The direction cf the tilt, d_, vas calculated to be 
[ .0301*6 .03383 ] t using Fqua. (28). In the top 

viev of Fig. 1, the position of d, is shovn relative 
to the plane of the scan in the x,y plane. This 
direction cf the 'tilt' is in agreement vith the 
earlier observations of the range data. 


THE MAPS P0VEP: AN APPLICATION 


INTERPFETATI CN OF THF PFSULTS 


The techniques shovn in this paper vere developed 
to analyze actual test data from the laser rsnre- 
! finder developed for the Mars Rover fren tests 
performed at Jet P rcpulsicr. Lab. 4 Pasedena, CA. 
and obtained from Mr. 3. Dobrotin. 

The rangefinder, consisting of a laser photodeteet- 
! or, and an electronic circuit, reasures tire of 
flight by a time-to-pulse-height conversion tech- 
nique. It uses a 10 bit A/D converter to obtain 


A comparison of these statistical results cf values 
provides useful information. Poth the e. and the 
r! shovn in Table 1 Indicate a trend of curvature 
in the data. Because it appears in the three-di- 
mcr.aicnal analysis, the trend is r.ot due to the 
tilt of the plane. This non linearity is from the 
device itself and originates either in the eleva- 
tion mechanism, the range measurement apparatus, 
or both. 
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The standard deviations of the three-dimensional 
analysis are In general smaller than those of the 
' two-dimensional analysis. This is expected he- 
I cause the three dimensional analysis removes the 
added errors due to the tilt in tne test. The 
• standard deviations, R", ranre from approximately 
2 to 7 mm. Studying these SJ, one vill notice a 
trend of increasing error asthe distance of the 
range value increases (Rev 1 has the largest range 
values). Because the change is not significant, 
i however, an actual value of the error cannot be 
! established. The standard deviations and S* 0 
! are 7«7b om and 5-12 mm. They are larger by about 

I U ran than the other values of P* around then. In 
subsequent tests, the standard deviations of these 
, rows should be checked to see if this problem re- 
, occurs. 

Before the data in Table 1 is interpreted further, 
the quantization error must be estimated. The 
' standard deviation, S , of the quantization error 
' can be found independently of the scan by the 
: following formula, where A is the difference be- 
tween successive quantization levels: 



For this data set, A equals Arm: therefore, S 
, q 

equals 2.6 mn. Except for rows 6 and 30, the S* 

range from 2.9 to b.7 mm. Most of the inaccuracy 
therefore is due to quantization error. The next 
largest source of error is the nonlinearity of the 
range readings. The inaccuracy due to this non 
linearity makes the perfcnr.ar.ee of the rangefinder 
poor for the range of approximately 1 to 1.3 meters. 
Modifications to the rangefinder should be made 
if it is to be used in this range. 

CONCLUSION 

This paper has presented two methods to analyze the 
accuracy of a rangefinding device. 

The two-dimensional analysis is useful when the 
rangefinding device has been aligned so that its 
vertical axis is perpendicular to the scanned plane. 
The errors, e< , introduced from the rangefinding 
device or other sources can be observed in Table 1 
of the means R, , and standard deviations, S^. A 
visual inspection of the e, will reveal any non- 
linearities of the data. These nonlir.earites of 
the system are shown at different elevation angles 
and, hence, at different range distances. 

The three-dimensional analysis is used when a "tilt" 
exists between the scanned plane and the vertical 
axis of the rangefinding device. In this method, 
the plane of the scan is determined using a least- 
squares estimate. T rom the ecuation of the esti- 
mated plane, the vertical axis can be realigned, 
for the actual device and the test can be run again. 
Also, values of range data can be computed from the 
equation of the estimated plane. The difference of 
these values and the actual range data car be used 
to give a rough estimate of the accuracy when "tilt" 
exists. 

If it is possible to rake multiple tests of the 
rangefinder, the best approach is to first correct 
the alignment of the rangefinder using the second 
method, and then use the first method to analyze 
the data from the rangefinder test. 


The methods Just described show the errors of the 
. _ rangefinding device as the elevation angle, G, 
changes or, equivalently, os the distance of the 
measurement increases. The source of these errors 
are the elevation angle positioning mechanism or 
the distance measuring device itself. Other sourc- 
es of error that are included in the error estimate 
— are quantization error and error due to noise in 
the environment. The quantization error can be 
estimated Independently and compared to the final 
results. 

The change of range reading with the intensity of 
the reflected pulse is also important (3). The in- 
tensity of the relfected pulse can be changed by 
changing the reflecting surface or by changing the 
angle of the reflecting surface with the incident 
beam. The errors due to the latter are measured by 
the methods in this paper; because as the distance 
of a range data increases, the angle that the sur- 
face forms with the bean also increases (1*). How- 
ever, these errors and the errors due to increasing 
distance of the measurement cannot be secarated in 
the analysis. It is recommended that a testing 
scheme be constructed that could measure the errors 
due to changes of intensity. 


Table 1. Statistical Results 


Rev 


S i 

e i 

r 'l 

*1 

"i 

i 

m 

inn 

m 

m 

ran data/row 

1 

1261*. 00 

5.71 

2.23 

2.73 

1 * . 1*5 

2b 

2 

1252.52 

5 . 1 b 

2.23 

2.35 

3.69 

23 

3 

1239-96 

5.87 

0.90 

1 . 1*3 

3.81 

25 

it 

1230.56 

b .56 

2.50 

3.05 

b. 3b 

26 

5 

1218.97 

b .27 

1.65 

2.72 

b.30 

29 

6 

1210.18 

5.65 

3.39 

b.AO 

7.7b 

33 

7 

1196.57 

2.63 

0.09 

1.93 

b .6* 

37 

8 

1187.27 

b . 17 

0.88 

2.55 

b.66 

37 

9 

1177.19 

3.93 

0.69 

2.18 

3.7b 

37 

10 

1166.5b 

b .78 

-0.27 

1.05 

b.33 

37 

11 

115b. 62 

5.12 

-2.71 

-1.65 

3.51 

50 

12 

111*5.52 

b .85 

-2.51 

- 1.61 

3.3A 

50 

13 

1135. b6 

5 . bb 

- 3 . 1*6 

-2.71 

b.lb 

50 

lb 

1127.28 

b.99 

-2.71 

-2.11 

3.33 

50 

15 

1118.58 

5.17 

-2.65 

-2.20 

3.27 

50 

16 

1110.62 

b .58 

-2.03 

-1.71 

3.23 

50 

17 

1101.02 

5.51 

-3.21 

-3.03 

b.lb 

50 

18 

1093- b6 

5.17 

-2.50 

-2.1*5 

b.01 

50 

19 

IO 85 . bb 

I 1 . 7 A 

-2 . bb 

-2.52 

3. A3 

50 

20 

1078.72 

3* 7 9 

-1.22 

-1.1*2 

3.36 

50 

21 

1070. bb 

b.Ub 

-1.71 

-2.03 

3.eb 

50 

22 

IO 63 . 6 O 

3.77 

-0.71 

-1.1b 

3.17 

50 

23 

1055. Ab 

3.32 

-1.06 

- 1.61 

3. b0 

50 

2b 

10bA.Q6 

b.52 

0.32 

-0.3b 

3.10 

50 

25 

10b3.60 

3. A0 

1 .IS 

0.b2 

2.88 

50 

26 

1036.86 

b.b£ 

1.53 

0.66 

3. bb 

50 

27 

1029. ?b 

3.36 

0.87 

-0.10 

3.31 

50 

28 

1023.72 

l».l*3 

2.19 

1.12 

3.02 

50 

20 

1017.60 

b.99 

2. Q8 

1.81 

3. b0 

50 

30 

1013.60 

6.15 

5-57 

b . 31 

5.12 

50 
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Task B. Path Selection System Simulation - B. Longendorfer 
Faculty Advisor: Prof. D. K. Frederick 

The overall objective of this task is to define a path selection 
system for the exploration of the surface of a planet using Mars as a 
case. Because of the delay introduced by one-way communication to Earth 
from Mars (on the order of twenty minutes), the vehicle must be able to 
sense its environment and direct its own movements without human assistance. 
Accordingly, algorithms are sought which will organize the collected data 
into an appropriate "world model", and utilize it in choosing an optimal 
safe path. 

The paticular methods investigated are edge-detection techniques. 

Edge detection techniques require a matrix of range/pointing angle data. 

Sudden changes in magnitude between adjacent elements, or differences in 
the rate of change of these magnitudes signal the existence of "edges". 

The application of these techniques to the Mars Rover requires much 
supporting simulation work. For example, the matrix of input data consists 
of laser range readings from a specified field of view, requiring the simula- 
tion of a range-finding sensor. 

Practical problems arise when considering the multitude of situations 
that occur in the physical world. Flat field, Mngle obstacle encounters 
(with which most of the theoretical work has been done) are rare. Problems 
such as what initialization procedures shall be used, which side of an edge 
(or both) constitutes an obstacle, what threshold values yield the "best" 
performance, etc. must be considered. At times, additional processing might 
be required to obtain a more complete picture. 

The vehicle then must relate the resulting matrix of edges to the 
actual environment, through a Terrain Modeller. The Terrain Model must 
calculate the actual location of the obstacles sensed, their approximate 
size and height, their relationship to the surrounding terrain, and the loca- 
tion of scanned (known) and unscanned (unknown) regions. Work on the Terrain 
Model has reached the debugging and concept testing stage. 

Once information about its surroundings is available to the vehicle, 
it must select a safe optimal path to its target. The method employed is 
called a path selection algorithm. The algorithm is necessarily influenced 
by the data-acquisition method in such factors as the conservatism of the 
method (because of the susceptibility to noise or the lack of it), and the 
type of obstacles which the sensor is intended to detect (discrete obstacles, 
slopes, positive or negative obstacles). Work on the path selection algorithm 
is in the planning stage. 

Sensor 


A laser rangefinder sensor was specified for a nominal range 
of three to thirty meters. Previous sensor simulations were not 
suited to this particular task. They allowed for only a small 
number of elevation angles (one to four), and these were con- 
strained to certain values (for example, only horizontal). Azimuth 
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angles were similarly constrained. Clearly, the sensor used 
in edge detection needed to be able to generate a large matrix 
of readings at one time, at any angle coordinates. The sensor 
now programed overcomes these defects, as well as providing 
for time lapse while scanning. Noise affecting the range read- 
ings is taken into account in two ways : 

(1) noise of specified type, mean, variance, maximum 
amplitude, natural frequency, and damping constant 
may be added directly to the range readings, and 

(2) the specified accuracy of the sensor may be changed 
by the user. 

Plans for further work on the sensor include the modification 
of the added noise by a factor proportional to the range squared, 
in order to better simulate errors in time of flight measurement. 

The sensor simulation uses the following method to compute 
range readings. It first calculates the position of the laser 
and the position of the location where the laser would intersect 
ground, both with respect to the vehicle, assuming no slopes. 

It transforms both points to the planet reference frame, by its 
knowledge of vehicle heading, and actual in-path and cross-path 
slopes. It calculates the direction cosines of the line connect- 
ing the two points and steps along this beam with a user-specified 
increment (BEMSTP, usually set to five centimeters), until it finds 
itself below the actual terrain level. It enters a bisection 
scheme until the desired accuracy is reached. The accuracy is a 
user-specified input (SdSTP) and is defined as the difference 
between exact measurement and the computed measurement (not as the 
difference between the height of the computed measurement and the 
terrain at that point, as in previous sensors). Efficiency of the 
sensor is vastly improved by the use of an initial guesc at the 
range reading, and logic which will not recalculate transformations 
unless the vehicle has moved from its previous position. The initial 
guess is taken to be zero for the elevatior angle nearest the vehicle. 
For other elevate n angles, the guess is set equal to a value some- 
what smaller tlian that for the elevation angle nearest to it but 
closer to the vehicle. 

Testing of the sensor is now complete. 

Scan Generator 


The scan generator serves as a preprocessor for input and 
output for the sensor. It allows input in a variety of convenient 
forms and calculates the necessary azimuth and elevation angles to 
cover the specified field of view while maintaining a certain data 
density. Because of the requirement that the Kalman filter must 
receive only angles spaced by a constant number of degrees, the data 
density (number of points per square meter) will vary, sometimes 
quite drastically. 

Input may appear in the form of a list of angles, or maximum, 
minimum and incremental angles, or in the form of field dimensions 
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such as length, width, center and maximum point spacing. 
Testing is now complete. 


Ei^e Detection Techniques 

The edge detection programs had to be interfaced with the 
existing simulation package. 

The edge detection routines employ a Kalman filtir, which 
is performed separately on each row and each column. Row process- 
ing looks for changes in the magnitude of range readings (vertical 
edges), while column processing looks for both magnitude and 
slope changes (horizontal edges). The Kalman filter predicts 
values for each clement of the array in succession, and computes 
the probability of an edge having occurred at that stage bas-'d on 
factors such as the difference between actual and expected values, 
the probability that an edge will occur, the cost of making a 
wrong decision on the location of the edge, etc. Bayes' Risk 
calculations weighted by these considerations make the actual 
decision. 

The performance of the edge detection routines has been tested 
by generating a terrain with the simulation package, measuring 
ranges with the sensor, and attempting to reconstruct the edges 
with the computer programs. Varying success has been attained, as 
shown in Figures 1 through 5. Problems identified here will be 
explored further in months to come. 

The bottom edges of boulders and the far *>dges of craters 
have not been shown by the program. To remedy the situation, two 
courses are presently being pursued. One possible solution is to 
replace some of the threshold values (originally programmed as 
constants) with variables, and re-test the performance. Another 
solution is to install an auxiliary test to look specifically for 
an important situation not now being identified. A "moving average" 
or constantly updated average value, will flag changes in slope 
greater than this average plus a tolerance or expected changes that 
fail to occur (i.e. changes less than this average minus a tolerance). 
The first case would signal the far edge of a negative obstacle while 
the second case is that of the near edge of a positive obstacle. 

At present, the "moving average" is uble to be engaged or disengaged 
by a rlag so that its effect may be studied. The tolerance itself 
is selected as a fraction of the computed average difference ".i as 
the value computed assuming the maximum transversible slope. 

Noise seems to have very little effect on the performance of 
the Kalman filter. Figures 4 and 5 show the effects of unfiltered 
white noise, which was added independently to eacn of the range 
readings. Range readings differ by as much as twenty centimeters 
along the same row (which should ideally have exactly the sane 
readings, since they result from identical elevation angles). 
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Another problem is the correct initialization procedure to 
follow. Until recently, initialization involved calculating 
expected range readings and changes in range readings given that 
the surrounding terrain was a flat plane. Changes in slopes be- 
tween elements of a column were done the same way. However, a 
new initialization procedure is being tried at present. Rows and 
columns are initiated to the range reading actually obtained. If 
an edge is actually present there, it will occur at the next stage 
instead. The small inherent error will be more than compensated 
for by the lack of initialization error on slopes, which could 
possibly block off an entire forward path. 

Terrain Model 

The Terrain Model interprets the data obtained from the 
sensor and edge detection routines, and translates it into an 
organized, easily understandable form. The Path Selection Algorithm 
is then freed from the concern for which method was actually used to 
obtain the data, and it can be a much more generally applicable pro- 
gram. 


The Terrain Model presently being developed divides the general 
region of the vehicle and target into a grid of squares, and uses 
them as a type of obstacle map to provide memory. 

There are several stages preceding the construction of the 
final obstacle map. First, the edge matrix provided by the edge 
detection routines must be scanned for edges. The model must 
decide on which side of the edge (or both) the obstacle lies, and 
whether the obstacle is positive or negative. This is currently 
determined by taking an avprago range over the proposed obstacle 
(i.e. that terrain which is between one edge and another, where 
an edge is defined as the beginning or end of a row or column or as 
the edge identified by the detection programs). The average range 
is compared to a value plus or minus a threshold. The comparison 
value currently corresponds to that for flat ground, but a better 
comparison of the known surface area (such as prediction from ortho- 
gonal polynomial least squares) will soon be employed. This is an 
example of the interaction of the terrain model and the edge detec- 
tion routines. Second, all matrix elements determined to be within 
the obstacle are marked according to type and blocked out. Third, 
all squares on the obstacle map of the environment which contain any 
part of the region scanned by an edge in the edge matrix are also 
marked with the obstacle type. This can be achieved by using attitude 
data and some geometry to obcain the planet (x,y,z) coordinates at the 
scan point. Projecting the obstacle location on to the xy-plane 
yields the map location. Actually, this is done at any point of the 
entire region sampled by one data point which will cause a new ,quare 
to be blocked on the obstacle map. Further information may be ob- 
tained and included in the map such as a height code, which would be 
useful for computing and storing slope, and flagging hazardous terrain. 
However, this has not as yet been incorporated in the model. Edge 
detection is designed to handle discrete obstacles, so that has been 
the main area of concentration of effort so far. 
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All terrain is initially labelled as unknown and is changed 
to another code only after it has been scanned at least once. 

Certain problems remain to be dealt with. Storage and 
memory capabilities directly conflict in the choice of the size 
of the blocks on the obstacle map. However, if only a certain 
amount of memory is needed while a large amount of terrain is to 
be covered, a "rolling pointer" might be used, which would indicate 
the current farthest sensor reach, while old data would be over- 
laid with new data from a different region. Another problem is the 
conflicting declarations of obstacles. Depending on the conservatism 
of the algorithm, differences in successive measurements would make 
the algorithm more or less sensitive to noise. 

Other assumptions include: 

(1) The vehicle has been supplied with a map of its 
surroundings up to a certain radius at the begin- 
ning of the simulation (otherwise a fixed sensor 
could never scan the field). 

(2) The sensor cannot change, add or delete angles 
from its scan once they are initialized. 

(3) Primary effort should be given to the detection 
of discrete obstacles. 

Path Selection Algorithm 

The problem of selecting a path given an obstacle map consisting 
of squares has t:en dealt with by C.Y. Lee, Reference 1 and F. Lallman, 
Reference 2. 

The algorithm consists of: 

(1) identifying the known (scanned) region 

(2) finding a minimal length path to the target 

(3) following the portion of this path of maximum 
length until the target is reached or another scan 
is necessary. 

The minimal length pcith is identifier by placing numbers in 
ascending order in blocks adjacent to the target, adjacent to the block 
adjacent to the target. As long as the vehicle progresses from one 
number to the next lower number, it is following a minimal length path. 

Problems not considered in the literature that are faced here are: 

(1) The vehicle may be more than one square in dimension 
of length or width. 
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(2) The vehicle has inherent dynamical characteristics 
and •'.annot turn abruptly. 

(3) The vehicle scans only a small portion of its 
surroundings . 

(4) The vehicle cannot proceed within a certain radius 
of unknown terrain without losing the ability to 
sense obstacles that may be present. 

Edge defection appears to be able to overcome two of the basic 
problems other path selection algorithms could not easily deal with: 
noise, and confusion of slopes with discrete obstacles. The trade- 
off seems to be memory space and computation time. 

Since simulation efforts are only now giving way to proposed 
problem solutions, it is too early to draw definitive conclusions. 

A reprint of a paper describing the application of this simulation 
code to the evaluation of a triangulation-based short range hazard 
detection system follows. The reprint is included to illustrate some 
of the type of output which can be expected when complete simulations 
of the concepts described herein are implemented. 
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THE MILWAUKEE SYMPOSIUM ON AUTOMATIC COMPUTATION ANO CONTROL 


GUIDANCE AND CONTROL OF AN AUTONOMOUS ROVER FOR PLANETARY EXPLORATION 


ORIGINAL PAGE iS 
OF POOR QUALITY 


S. Yerazunis, D. K. Frederick and J. Krajewski 


Rensselaer Polytechnic Institute 
Troy, New York 


A four-wheeled vehicle capable of deal- 
ing with Irregular terrain features such as 
might be encountered In unmanned exploration 
of extraterrestrial bodies has been designed, 
constructed and tested. Its mobility and 
maneuverability are such chat applications 
on earth requiring autonomous control may be 
served by it or a suitable variation. It 
could also serve as a test bed for arti- 
ficial intelligence/robotics research. Al- 
ternative concepts for terrain sensing and 
modeling, and path selection algorithms have 
been investigated. A triangulation-based 
laser/photodetector path selection s-'stem 
developed by simulation is found to je able 
to deal with a broad range of terrain fea- 
tures. The path selection system is now in 
the process of construction and implementa- 
tion and will permit field evaluation of the 
overall vehicle system as in autonomous 
rover. 


INTRODUCTION 


restricted sampling range of its ten foot boom 
with a 120° arc. Thus only a minute fraction of 
the martian surface will have been scrutinized 
and a larger but still very small fracticn as 
limited by line of sight will be examined visual- 
ly. A more thorough exploration is not likely to 
be effected by increasing the number of such 
stationary landers because of the large number 
which would be required and the problem of se- 
lecting and reaching precise landing sites where 
critical measurements can be made. A method for 
exploring the planet in question in detail and to 
do so adaptively on the basis of the knowledge 
being gained is essential. 

The scenario for planetary exploration could 
involve either a stationary lander containing 
sophisticated and adaptable instrumentation 
for in-sltu analysis or a sample return vehicle. 
In either case, the scenario must involve sample 
and/or data gathering devices capable of being 
relocated over much of the planetary surface, and 
in the case of sample gathering devices, capable 
of returning to the lander site. In order that 
such missions can be executed in a rtisonable 
time of the order of several months t) perhaps a 
year, such sample or data gathering devices must 
have a high level of both mobility and automa- 
tism. 


The very long term interests of man re- 
quire that a thorough exploration of the 
planets of the solar system, their moons and 
the asteroids be undertaken eventually. Al- 
though it is likely that man himself will 
visit or establish himself ultimately on some 
of these extraterrestrial bodies, economic and 
technological considerations suggest that un- 
manned systems must be used during the shorter 
run. 

Considerable knowledge of Mars, Venus, 
Mercury and Jupiter has been gained by fly-by 
or orbiter missions and more advanced remote 
sensor concepts will contribute further to 
man's understanding of the solar system. How- 
ever, basic understanding of the chemical, 
biological, geological, meteorological and 
physical characteristics of extraterrestrial 
bodies requires surface exploration. The 
current Viking missions are intended to meet 
some of these requirements for the planet 
Mars . 

Despite the historic implications of the 
Mars Viking program, Viking-type missions are 
severely limited in scope because of the 


The mobility requirements as expressed in 
terms of characteristics such as the maximum 
slope which can be climbed or descended, the 
maximum boulder which can be negotiated without 
avoidance, the ability to transverse depressions 
and very rough terrains, etc., has a direct bear- 
ing on the availability of paths to the desired 
sites. A vehicle of limited mobility may require 
an inordinate length of time and distance travel- 
led to reach the target. Indeed, in some circum- 
stances, the vehicle may not be able to reach the 
target. As the vehicle's mobility is increased, 
it will be able to deal effectively with in- 
creasingly difficult terrains. More paths to 
target will be available and the opportunity fo. 
selecting more optimal paths will be Increased. 
Thus, one major research objective should be 
aimed at developing and evaluating alternative 
concepts of relocatable devices capable of serv- 
ing a stationary lander or sample return mission. 

Of equal importance to advanced exploration 
missions is the level of automatism which can be 
achieved. The decision for the vehicle to 
follow one path or another towards its destina- 
tion must be provided by some path selection 
system comprised of appropriate terrain data 
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sensors, terrain modeler and path selection 
algorithm. The character and capabilities of 
such a system must be approprl.te to the objec- 
tives of the mission. A low level path selection 
system will have to be biased conservatively to 
minimize the risk of an unpercelved hazard In the 
vehicle's path. Thus many, perhaps all, accept- 
able paths towards the target may be excluded. 

The effect of a low level detection system is, 
in fact, to reduce the vehicle's mobility. As a 
minimum, the path taken towards the destination 
will be lengthier and the range of the explora- 
tion will be reduced. In the other extreme, the 
vehicle may become Immobilized. On the other 
hand, a higher level, more sensitive, more per- 
ceptive path selection system will Identify a 
larger fraction of the passable paths and will 
permit selection of those directions most com- 
patible with the mission goals. Thus a second 
major research objective is the development of 
efficient path selection systems for the safe 
relocation of a rover. 

The research program ^ aimed at these two 
major objectives is applicable not only to 
extraterrestrial exploration but to robotics ap- 
plications on earth where hostile environments 
and special circumstances may exclude either di- 
rect or remote manual control. The major 
emphasis of this paper Is on the rover and the 
path selection system selected for immediate im- 
plementation. 

THE RENSSELAER ROVER 

By virtue of Its design the vehicle has a 
very high mobility and maneuverability, Ref. 1 
and 2. In Its deployed state. Figure 1, it has 
a stable stance allowing it to traverse very 
irregular terrain. The configuration of the 
struts serving the Individually-driven wheels 
permits this vehicle to be collapsed into a com- 
pact space, Figure 2, from which It can be de- 
ployed automatically. The struts, which are 
driven separately by torsion bars, can be used 
to raise or lower the payload compartment as re- 
quired and to orient it fore-and-aft with res- 
pect to the horizontal. The front wheel wagon 
steering insures that all four wheels will be in 
contact with the terrain for all but the most 
severe surface Irregularities. It also permits 
a sharp turning radius such that In the extreme 
case, the vehicle can turn about a center through 
the rear wheel axles. The vehicle Is able to 
deal effectively with a broad range of slope 
situations and discrete obstacles. 

Perhaps the most outstanding feature of the 
design Is that this vehicle can recover from the 
situation in which both front wheels fall over 
the edge of a crevasse or a deep crater. For all 
other vehicles which have been proposed, such an 
event would be catastroplc and would terminate 
the mission. That Is not so with this concept. 


(1) Faculty participating in the overall re- 
search program are: Profs. D.K. Frederick, 

D. Glsser, G.N. Sandor, C.N. Shen and S Yera 
zunls. 


Because of the unequal lengths of the front and 
rear struts and the torsion bar system, the front 
and rear wheel assemblies can be reversed and the 
vehicle can withdraw safely from the hazard. This 
same maneuver can be used to extricate the vehicle 
from a "box canyon" or equivalent terrain feature 
In which there is Insufficient room for the vehicle 
to turn Itself around and from which it may not be 
able to back out. Previously proposed vehicles 
would also fall in this Instance. 

'"he vehicle has been refined to the point 
where it can serve as an exceptional test bed for 
the evaluation of alternative path selection sys- 
tems. In this sense it is a valuable asset for 
exploring artificial intelligence or robotic as- 
pects related to a machine seeking an acceptable 
path to a prescribed destination, an objective not 
necessarily restricted to extraterrestrial ex- 
ploration. 

In addition to the mechanical and propulsion 
systems, the rover Is equipped with electronic 
four-wheel speed controls to permit effective 
steering, attitude and heading gyroscopes, posi- 
tion sensors for all major strut components, and 
a two-way telemetry link to an off-board mini- 
computer to provide the necessary vehicle data 
for guidance and control. All that remains Is the 
implementation of the hardware and software re- 
quired for an operating path selection system. 

PATH SELECTION SYSTEM SIMULATION 

The path selection system required to guide 
an autonomous vehicle must Include: terrain 

sensor or sensors hardware, procedures for inter- 
preting the data, and an algorithm for selecting 
safe paths on the basis of the data. The best 
combination of hardware and software will depend 
on the details of the mission and the dynamical 
and mobility characteristics of the vehicle or 
robot. An optimization of these requirements 
through an iterative process of constructing and 
evaluating specific hardware and software will be 
inordinately expensive and tedious and is not 
likely to be optimal. A digital computer simula- 
tion has been developed which can be used to 
screen all conceivable systems, Ref. 3 and k. The 
simulation can "create" a very broad spectrum of 
terrains possessing such large and small scale 
details as desired. The pitching, heaving and 
rolling of the vehicle can be simulated and their 
effect on the terrain sensor data can be evalua- 
ted. The terrain sensor can be simulated to re- 
flect both the error due to the motion of the 
sensor as a result of vehicular dynamics and the 
inherent sensor measurement errors. Proposed 
terrain modelers and path selection algorithms can 
be analyzed, evaluated and modified. When these 
considerations are taken all together, a first but 
meaningful appraisal of the strengths and weak- 
nesses of proposed hardware systems can * e obtain- 
ed. Its application to a specific path selection 
system Is described later in this paper. 

ALTERNATIVE TERRAIN DATA GATHERING CONCEPTS 

Efforts in developing alternatives for the 
gathering of terrain data have been focused on: 
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(a) a range-pointing angle concept and (b) a trl- 
angulatlon concept. 

An ln-depth study of the use of rangc-anple 
pointing data for terrain modeling and hazard de- 
tection has been on-golng for several years. This 
phase, which ha resulted In numerous publications, 
Ref. 5, 6, 7, 8, 9, 10, has focused on the mid- 
range problem from 3-30 meters. Methods have been 
developed for Interpreting these data to obtain 
estimates of the terrain gradients and to detect 
discrete objects whose contours deviate from the 
main terrain. Edge detection and edge enhancement 
techniques have been developed which provide com- 
plete outlines of boulders, ridges, craters and 
crevasses provided that a sufficiently high data 
density Is available. Current efforts are concen- 
trating on the problem of reducing the data re- 
quirements without sacrificing the effectiveness 
of the Interpretation. These studies are con- 
cerned with the data density In both time and 
space and to the Implications of Inherent sensor 
errors and errors due to the motion of the sensor 
as a consequence of vehicular dynamics. 

As an alternative, a short range (1-3 meter) 
system based on triangulation has also been in- 
vestigated. Indeed the latter system has been 
selected for Implementation on the Rensselaer 
Rover. The concept is illustrated in Figure 3 
In which are shown a laser beam along one point- 
ing angle and a photodetector along a second 
pointing angle. The existence of a reflecting 
surface, i.e., terrain within the zone of inter- 
section, will be sensed by the photodetcctor. In 
principle, any number of lasers and photodetect- 
ors can be deployed to obtain terrain surface 
data to any desired density and discreteness. 

This information can then be used as the oasis for 
modeling the terrain and making path selection 
decisions. 

From a terrain modeling point of view, the 
range-pointing angle and triangulation concepts 
are equivalent. That is, both concepts provide 
the same type of data In that the terrain surface 
Is concluded to lie along a line segment of some 
length and angular orientation. However, the two 
concepts Involve different technical obstacles In 
their implementation. The uncertainty of locating 
the terrain surface along the line segment using 
the range-pointing angle concept is determined by 
the ability of Instrumentation to measure tlme-of- 
flight with possibly weak return signals and In 
the presence of undeslred reflections. As one’s 
objective In hazard detection focuses more on the 
short-range aspect, the t Ime-of-f light measure- 
ment becomes Increasingly difficult due to the 
need to measure extremely short time intervals. 

On the other hand, the uncertainty related with 
terrain location by triangulation is controlled 
by the geometrical relationship of the laser and 
the detector and the cone-of-vision of the latter. 
By using overlapping detectors and by scanning 
with a high frequency laser, the uncertainty can 
be made extremely small for the short range. How- 
ever, the triangulation system begins to suffer 
Inherent and significant uncertainty In long 
range applications. Thus, hardware systems based 
on range-pointing angle data look more attractive 
at longer ranges whereas the tr langulation con- 
cept is far more favorable at short range. 


Given the objective of demonstrating a mini- 
mal level of autonomous roving capability, it was 
concluded that a path selection system based on 
the triangulation concept would be Implemented. 

THE PROPOSED PATH SELECTION SYSTEM 

As noted earlier, a path selection system 
consists of a sensor(s) to gather the data, a 
terrain modeler to process the data into a proper 
form, and a path selection algorithm to employ the 
modeled results with the objective of defining 
guidance commands. The path selection system 
which has been chosen for hardware and software 
Implementation consists of two lasers scanned 
azlmuthally along fifteen positions equally spaced 
at 10° to provide a 140° field of view. One 
photodetector possessing a 9.6° cone of vision 
will also be scanned over the same azimuthal 
angles. The two lasers will be located at a height 
of 1.5 meters at elevation angles of 43° and 46° 
whereas the photodetector at the 0.75 meter height 
will have an elevation angle of 62°, Figure 3. 
These Initial design parameters are specified on 
the basis of the simulation studies completed to 
date. The mast on which the lasers and the photo- 
detector are to be mounted has been constructed to 
provide up to 6 azimuthal 140° sweeps per second. 
The Instrumentation mounting arrangements are such 
that the lasers can be scanned in elevation as 
well as azimuth and that additional photodetectors 
can be added as desired. Finally, the mast con- 
figuration will allow for significant adjustment 
of the geometric parameters so that the research- 
ers will have considerable flexibility In studying 
more sophisticated triangulat lon-based alterna- 
tives. 

Central to the task of demonstrating and 
evaluating this concept during the late spring of 
this year has been the path selection system 
simulation effort. It has fallen on this group to 
screen a number of design concepts and to synthe- 
size a specific alternative satisfying the basic 
requirement that the rover will not pursue a path 
which will abort the mission and that if a safe 
path to the specified target exists the rover will 
eventually detect it. Although tue long-term ob- 
jectives call for a high degree of discrimination 
on the part of the system to minimize the misin- 
terpretation of safe alternatives as hazardous, 
the studies completed to date have defined a mini- 
mum but feasible system. 

The path selection system simulation, Ref. 4, 
has the capability of simulating the performance 
of a broad range of surface rover concepts, alter- 
native data gathering concepts, data processors 
l.e. (terrain modelers) and path selection algo- 
rithms on a terrain selected by the user. The 
terrain can have large *cale features as well as 
fine detail. Inherent sensors errors can be 
simulated along with those sensors errors due to 
the dynamic motion of the rover as It moves over 
highly Irregular terrain and rubble. Thus, the 
simulation affords the users the opportunity to 
appraise alternative hardware and software con- 
cepts conveniently. 

In the case at hand, the simulation was used 
to develop the design parameters specified above. 
The anticipated behavior of the selected system 
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la shown on Flgurea 4 through 8. Note that the 
design parameters are set to detect a positive 
hazard (boulder or step) or negative hazard 
(crater or trench) in excess of approximately 
+ 12" from the plane defined by the attltudlnal 
status of the vehicle. With the single detector, 
this requirement Is equivalent to setting the 
maximum gradient to + 12°. Parenthetically, It 
might be noted that the 12° gradient Is far lower 
than the actual slope climbing capability of the 
Rensselaer Rover. Thus this system will rule out 
potentially passable paths because of Its in- 
ability to discriminate between slopes and dis- 
crete obstacles. 

Shown In Figure 4 are the results of three 
simulations as applied to a boulder-crater field 
superimposed on a flat base using the single 
laser-single detector concept described earlier 
assuming the absence of noise due either to In- 
herent sensor limitations or the pitch or roll 
vehicle motions. The proposed path selection 
system is found to be quite effective In dealing 
with this problem. Also shown in Figure 4 Is a 
simulation of this system with vehicle motion 
noise effects equivalent to fluctuations of + 5° 
in pitch and + 10° In roll at the contact points 
of the wheels. At these noise levels, the path 
selection was unaffected. 

The noise parameter referred to above is 
Intended to account for the vehicle motion caused 
by terrain features which are too small to model 
on an Individual basis. Random fluctuations In 
the pitch and roll angles are generated aid then 
added to the vehicle's attitude as determined by 
the slope of the deterministic terrain under the 
vehicle. These random fluctuations are computed 
by entering a sequence of uniformly distributed 
random numbers into a second-order low-pass 
digital filter whose damping ratio and undamped 
natural frequency are representative of the 
vehicle's dominant mode. The purpose of the 
filter Is to simulate the smoothing effect of 
the vehicle's suspension system. Roll and pitch 
are treated separately, with different random 
sequences. For example, using an unflltercd 
random sequence uniformly distributed over + 10 
degrees resulted in filtered angles having a 
standard deviation of + 3.74 degrees and ex- 
treme values of + 9.0 in the pitch direction. 
Hence, the excursions in the attitude of the 
mast and laser-detector combination are some- 
what less than the unflltered fluctuations which 
are assumed to exist at the wheel contact points. 
The standard deviation and the extreme values for 
other levels of vehicle dynamic noise would be 
proportional to these for 10 degrees. 

Also show In Figure 4 are simulations in- 
volving the two-laser system scheduled for imple- 
mentation with noise levels of 10° and 15° In 
both pitch and roll. The performance of the 
system continues to be effective despite the high 
noise levels. However. It Is clear that as the 
noise level due to vehicular dynamics and terrain 
Irregularities Is l.tCieaseo, a poln*: will be 
reached eventually at which the effectiveness of 
the path selection system will be degraded. This 
question has not been fully explored yet because 
as will be described below noise effects are far 
more significant in terrain situations involving 
surface undulations than on flat base terrains. 


Shown in Figure 5 are simulations involving 
a terrain described by sinusoidal functions. It 
should be noted that for a sinusoidal terrain of 
6 meter period and 0.20 meter amplitude in the 
absence of noise that the path selection system 
Is able to direct the vehicle In a straight line 
fashion between the initial point and the target 
destination. However, an increase of the 
amplltjde to 0.3 meter forces the one laser 
hazard detection system to depart significantly 
from the straight line path and to meandei to- 
ward the target. Although the target Is reached 
eventually a considerably larger distance travel- 
ed Is Involved. The path selection system can be 
improved by adding a second laser at an Incre- 
mental elevation of 3°. This modification has 
the effect cf providing additional information 
which allows the path selection system to take a 
somewhat more direct route toward the target. 
However neither system can achieve a direct route 
for an amplitude of this magnitude. Increasing 
the amplitude to 0.33 meters while retaining the 
period at 6 meters, causes both the one and two- 
laser systems to prescribe an even more tortuous 
path. At an amplitude 0.4 meters, the system is 
unable to contend with the situations anti falls 
to make progress towards the target. The simu- 
lations shown in Figure 5 highlight a major weak- 
ness in this simple hazard detection system, 
namely, its inability to distinguish between a 
slope and a discrete obstacle. The rover found 
Itself obliged to turn from the direct path at 
critical points where the sensor was detecting 
the existence of a moderate slope in excess of 
the 12° limit imposed by the assumed sensor sys- 
tem. It had to take on a direction such that 
the gradient to be encountered would be within 
the specified tolerance limits. This Is not 
necessarily a fatal flow since the rover was 
able to select a trajectory either up or down hill 
which would be satisfactory. But It did so at the 
penalty of taking an unnecessarily long trajectory. 

The consequences of dynamic noise are far 
more significant with respect to rolling terrain 
situations than in the case of the flat terrain on 
which a variety of boulder and crater obstacles 
arc superimp 'sed. This behavior Is shown In Fig- 
ure 6 in which the one-laser and the two- laser 
systems arc tested in a . 3 meter amplitude, 8 
meter prlod sinusoidal terrain with noise due to 
vehicle dynamics equivalent to 10° In pitch and 
10° in roll. In order to compare the two alter- 
natives, the same seed was used to generate the 
random mznbers which serve as the basis for cal- 
culating the noise. Thus, both systems were 
tested against the same exact sequence of dyna- 
mical ’.otlon. Both simulations failed to the ex- 
tent that extreme meandering and confusion is 
observed. It cannot be concluded that the target 
would not have been reached ultimately because the 
simulations were automatically terminated on the 
basis of a time constraint. However, what is 
Important to note In this comparison is that the 
two-laser system had no observable superiority 
over the one laser system in the case of this 
rolling terrain at this level of dynamical noise. 
Also shown on Figure 6 is the performance of the 
two laser system with vehicle dynamics noise re- 
duced to 5° in pitch. Although a meandering path 
was followed, the system would ultimately lead the 
rover to the target. 


38 


THE MILWAUKEE SYMPOSIUM ON AUTOMATIC COMPUTATION AND CONTROL 


Shown in Figure 7 are the of three 

slr..alationa all Involving a rolling terrain des- 
cribed by a .25 meter amplitude, 6 meter period 
alnuaoldal surface. Two of the almulatlona com- 
pare the effectlveneaa with which the one- and 
two-laaer ayatema could deal with thla rolling 
terrain altuatlon In the presence of 10° pitch, 

10° roll dynamical motion. Neither simulation 
proved to be particularly effective although the 
failure to reach the target la again a consequence 
of terminating the simulation rather "han a funda- 
mental Inability to achieve the target ultimately. 
Nevertheless, In the case of this level of dyna- 
mical noise It la clear that the path selection 
system Is forcing the rover Into very substantial 
meandering and Is therefore not considered effec- 
tive for both the one- and two- laser systems al- 
though the latter appears stronger. However, the 
third simulation Involving dynamical noise levels 
of only 5° In pitch but with the 10° roil retain- 
ed showed that the two-laser system was able to 
take a relatively direct route from the starting 
point to the final destination. This suggests 
therefore that in the design of an autonomous 
rover a significant Impact on the effectiveness of 
hazard detection and path selection systems can be 
obtained by careful vehicular design which mini- 
mizes the effect of dynamical noise upon the sens- 
ing devices. Another way of looklr~ at the 
significance of these simulations Is to note that 
it Is rho sum °f the gradients representative of 
the physical terrain situation and of the nois 
effects which determine how well the path selec- 
tion system will perform for a given vehicle. On 
the basis of the data at hand. It can be concluded 
that even with a 10° pitch noise due to dynamical 
motion that there would be some rolling terrain 
either with reduced amplitude and/or increased 
period which could be handled effectively by this 
system. In effect, the consequences of the noise 
associated with the dynamical motion Is to reduce 
the nobility of the vehicle by applying a bias 
required to offset the Impact of noise. 

Summarized in Figure 8 are the results of 
three simulations in t a absence of vehicle dyna- 
mics noise in which th«. boulder/crater field is 
superimposed on the s.nusoldal rolling terrain. 

The combined terrain features are sen to pcse a 
more serious problem than for either case sepa- • 
rately. Case l involving the vehicle origin in 
the upper right h md comer found the vehicle get- 
ting Itself Into an awkward position In which a 
considerable amount of maneuvering was required 
before a good trajectory toward the target could 
be defined. The discontinuities in path which are 
shown are a consequence of the simulation program 
which applies when the vehicle finds Itself in an 
impossible situation. The algorithm calls for the 
vehicle to back up 1 meter. As far as the simula- 
tion is concerned this backup Is Instantaneous and 
discontinuous. Case 2 involving an initiation 
point in the upper left hand comer for a two- 
laser system proceeded rather well to the target 
whereas the corresponding path for the onc-lascr 
system encountered difficulty near the target 
and a considerable meandering before reaching the 
target. Also shown for comparison in Figure 8 is 
the path selection process for the boulder/crater 
field on a flat plane. It can be seen that the 
effect of the rolling terrain is to deny to the 
vehicle the most direct route to the target. 
However, the final simulation shown involving a 


5° In pitch and 10° In roll vehicle dynamics 
noise closely parallels the path of Che noiseless 
flat terrain case. It would appear that In this 
case, the no'ic led to a fortuitous selection of 
path. 

Other simulations not reported herein have 
been conducted which suggest ways In which the 
system could be modified to deal more affactlval/ 
either with the discrete obstacle such as bould- 
ers, craters, trenches or with slope character- 
istics. The tendency to Interpret passable slopes 
as impassable can be reduced Increasing the cone 
of vision of the detector. However, the effect of 
this action is to increase the size of the posi- 
tive or negative discrete hazard to be Interpreted 
as passable. A decrease in the cone of vision of 
the detector will permit smaller discrete ob- 
stacles to be detected but at the penalty of de- 
fining lower acceptable slope thresholds. The 
design parameters which have been selected as of 
this date represent what is believed to be the 
bes- compromise for the purpose of demonstrating 
and «Vwluatlng this k' of a system in hardware. 

A* noted earlier, the problem of noise due 
to v< hi le dynamics has the effect of biasing the 
pach. selection decisions conservatively. The 
pitching or roiling motion of the vehicle provides 
false information which is interpreted as a 
vehicle hazard. It is also possible for the 
dynamical noise to give a false Indication that a 
hazard is not present even though it really is. 

The latter docs not prove to be significant be- 
cause subsequent scans will disclose the exist- 
ence of a real hazard, even though It may be 
overlooked on an individual scan. The reverse is 
not true; when a path is deemed to be b’oeked be- 
cause of the dynamical noise, the path selection 
algorithm treats It as being blocked and not only 
directs the vehicle otherwise but retains In its 
memory that that path is blocked. Consideration 
Is being given to Incorporating memory into the 
*;rrain modeler and path selection algoiithm so 
as to reduce the false identification of hazard- 
ous paths. Such a system should provide a basis 
for alleviating the type of erratic behavior 
hown in Figures 6 and 7. 

TV •'resent path selection system has one 
additions ...ajor fault to which attention is be- 
ing directed. Specifically, past researchers. 
Reference 11, have shown that a particular 
terrain feature may or may not be a hazard de- 
pending upon the main terrain characteristics on 
which the feature Is located. »hus in the ulti- 
mate, It will be necessary to relate the state of 
the terrain, as defined by the attitude informa- 
tion provided by the attitude gyroscope mounted 
on the vehicle to the data being provided by the 
hazard detection sensors. One possible solution 
is to Implement a higher level triangulation- 
based system, which Involves elevation as veil as 
azimuthal scanning of the laser and an Increased 
number of detectors with smaller cones or zones 
of vision. The effect of this type of a system 
is of course to decrease the coarseness of the 
infoi-vation. Provided that a sufficient ly fine 
mesh la obtained, pattern recognition techniques 
can be u.ied to obtain a much more detailed and 
Informative impression of the nature of *he 
terrain in the path of the vehicle. The informa- 
tion gamed in such a system could be tied to the 



39 . 


THE MILWAUKEE SYMPOSIUM ON AUTOMATIC COMPUTATION AND CONTROL 


vehicle aCtlCude data through appropriate mathe- 
matical relationships to provide a more sound 
decision as to whether the terrain feature Is or 
Is not a hazard for the vehicle's particular 
state. 

Alternatively, one could consider using the 
basic system described herein but replicating It 
In sufficient number so that only one of the sys- 
tems would be operational at a given time depend- 
ing upon the vehicle's attitude. Thus one might 
have a multi-unit system of the type described 
herein with the central unit applying to all 
situations In which the vehicle's attitude Is not 
far removed from horizontal, with the immediately 
adjacent two units applying when the vehicle's 
attitude is slightly upwardly or downwardly in- 
clined, and with additional adjacent units apply- 
ing at greater and greater attitudinal deviations 
from horizontal. The number of such units would 
depend on the need for refined terrain Information. 

Consideration Is being given to other sys- 
tems of Intermediate complexity, namely, five 9° 
detectors overlapped as to produce nine discrete 
signals in combination with from three to five 
lasers being scanned azlmuthally but with each 
laser at a very specific elevation. Such an 
intermediate system can be Implemented In hard- 
ware and software relatively easily and have the 
advantage of providing enough added Information 
to give the path selection algorithm a more re- 
liable basis for decision making. 

As of this writing, the research program to 
produce the required hardware, (i.e. lasers, 
photodetectors, scanning mast, etc.) and to 
program the software in a IDIIOM Graphlcs-Varlan 
Computer, which is to serve as the data processor, 
are proceeding vigorously. The rover Itself and 
Its on-board control systems and actuators are 
operational along with the telemetry systems re- 
quired to transmit data from the vehicle to the 
computer and vice versa. It Is anticipated that 
all systems will be active In the neighborhood of 
April 1, and that laboratory and field research 
will be undertaken shortly thereafter. 

CONCLUSIONS 

1. A path selection system based on a two- laser/ 
one-detector terrain sensor can be effective 
in guiding an autonomous rover over terrains 
whose general slopes are less than + 12° and 
on which are distributed discrete hazards 
larger than + 12 inches in the presence of 
vehicle dynamics noise of the order of + 5° 
in pitch and + 10° in roll. 

2. The performance of such a system can be in- 
creased provided that the state (i.e. the 
attitude) of the vehicle is taken into 
account in the interpretation of the sensed 
terrain data and that additional attitude 
dependent sensor units are added. 

3. Terrain sensors based on triangulation 
provide a basis for developing short-range 
path selection systems capable of dealing 
with very complex terrain situations. 
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Figure 1. The Rensselaer Rover In Its Collapsed 
Configuration 



Figure 2. The Rensselaer Rover In Its Deployed 
Con r iguration 



Figure 3 

Terrain Detection by Triangulation 
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— Single Laser System, No Dynamic Noise 
“ Single Laser System, + 5 Pitch, + 10 Roll Noise 
•— Double Laser System, + 10° Pitch, + 10° Roll Noise 
— Double Laser System, + 15° Pitch, + 15° Roll Noise 


Boulder 


One Meter 


Figure 4. Path Selection Simulation Through a Boulder/Crater Field on a Flat Base Terrain 



Figure 5. Path Selection Simulation Over a 6.0 Meter Period Sinusoidal Terrain in the Absence of 

Vehicle Dynamics Noise 
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Figure 7. Path Selection Simulation for a Sinusoidal Terrain of i'.25 Meter Amplitude and 6.0 Meter 

Period in the Presence of Vehicle Dynamics Noise 






